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A PASSIVE BALANCER FOR A CLASS OF ROTATING SPACECRAFT 


By C. William Martz and Carolyn Grantham 
Langley Research Center 

•i 

SUMMARY 

Equations of motion have been derived for a flexibly connected dual-spin spacecraft 
equipped with four pendulumlike "passive controllers" for mass balance and spin axis 
control. The derived equations, simplified by eliminating hub and flexibility terms, were 
analyzed to determine the conditions required for successful steady-state operation of the 
controllers with a spinning, rigid-body spacecraft. Results indicated that spacecraft 
inertia about the intended spin axis must be less than spacecraft inertia about the trans- 
verse axes. Also, positive damping of controller motion relative to the body is required. 

A generalized real-time computer simulation of a large, slowly spinning rigid-body 
spacecraft equipped with passive controllers has also been presented. Numerical results 
of this simulation show that passive controllers can successfully balance a class of rotat- 
ing rigid bodies undergoing large internal mass and inertial disturbances. Results also 
indicate a reduction in spacecraft attitude error due to the action of the controllers. The 
ratio of total controller mass to spacecraft mass need not be greater than 1 to 2 percent. 

INTRODUCTION 

Man in space may be unable to function over extended time periods without artificial 
gravity. A practical method for providing an artificial gravity environment, as well as a 
means of stabilization, is that of rotating the entire spacecraft or an appreciable part of 
the spacecraft, as is done in a dual-spin application. (See ref. 1.) It is anticipated that 
rotating space stations will require a means of preserving both the location of their mass 
center and the orientation of their axis of rotation. This requirement would insure that 
docking ports remain centered about the rotation axis and that steady, observations could 
be made from any nonrotating part of the station. 

The stabilization problem arises because of a necessity for crew members to move 
about the station and for supplies and equipment to be distributed and relocated during 
operation. Also, resupply vehicles occasionally will be coupled to the station. All these 
activities alter the mass center of the station and thereby the location of the rotational 
axis. Also, the mass redistribution introduces products of inertia that cause dynamic 



unbalance. The resultant wobbling and circling motion of the station may interfere with 
docking activities and pointing requirements. 

Existing technology for unmanned satellites is not directly applicable for controlling 
the axis of rotation and mass center of a manned space station. Wobbling of the station 
can be prevented by an active momentum storage system, but the associated weight 
increase may be prohibitive and such a system would be unable to prevent static unbal- 
ance and unwanted circling of the nonrotating part of the station. 

The proposed technique for spin axis and mass center control (that is, control of 
static and dynamic balance) of manned rotating space stations uses two sets of "passive 
controllers." Each set consists of two pendulumlike masses free to rotate concentrically 
about the desired spin axis in planes perpendicular to the spin axis. See figure 1. If the 
actual spin axis initially is not coincident with the desired spin axis, the centrifugal forces 
generated by the spinning motion will automatically deflect the controllers in such a way 
as to drive the actual spin axis toward the desired location. The passive controllers 
should incorporate sufficient damping to minimize their settling time after introduction of 
an unbalance. Once in operation, the controllers rotate with the spinning part of the sta- 
tion and need only gradual relative movements to perform their function automatically. 

As part of an overall study, this paper develops equations of motion for a flexibly 
connected dual-spin spacecraft equipped with passive controllers. However, the intent of 
this paper is to investigate controller and spacecraft dynamics for a rigid-body space- 
craft. Thus, the derived equations of motion first were simplified by eliminating hub and 
flexibility terms. A steady-state analysis of the resulting equations was performed to 
define design conditions required for successful operation of the controllers with a rigid- 
body spacecraft. Also, the simplified equations were used in a digital computer simula- 
tion to obtain the dynamic response of the spacecraft and controller system to large crew 
motion disturbances. 


SYMBOLS 

A bar over a symbol indicates a vector quantity. A dot over a symbol indicates a 
derivative with respect to time. A prime with a symbol denotes a derivative with respect 
to T. A symbol within braces { } also indicates a vector. A symbol within brackets £ ”] 
indicates a square matrix. If this symbol is a vector quantity, however, its use in brackets 
indicates a particular type of skew symmetric matrix as illustrated by the following 
example: 

Let 



2 



Then 


B 


0 - r Z r y 


-r y r x 


M 


disk Euler rate vector. 


[<f> e i //] 1 


- |Ai| location of total mass center in disk coordinates, = [pi] 

A l,xy 

a l> b l> a 2> b 2 

w 


2 2 

total mass center offset in x,y-plane, \jA-l f x + A l,y 
defined in equations (43) to (46), respectively 


hub Euler rate vector relative to disk, 

[c] translational damping constant matrix between disk and hub 

[C R ] rotational damping constant matrix between disk and hub 

Cj jth controller damping coefficient where j = 1, 2, 3, 4 

[ D ] transformation matrix, disk Euler rates to disk body rates 

|diJ orthogonal transformation matrix, disk components to inertial components 

Jl^j orthogonal transformation matrix, hub components to disk components 

orthogonal transformation matrix, controller components to disk components 

jD^J transformation matrix, disk-relative hub Euler rates to disk-relative hub 

body rates 

components of total external force parallel to disk coordinate axes, 
(F d } + [D 2 ]{F h ( 

|F d J external force components applied to disk along x-, y-, and z-axes 
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N 

F d 

G 

'h 


external force components applied to hub along x^-, y^-, and z^-axes 
dissipation function 

dimensionless quantity (see eqs. (17) and (33)) 

distance along z-axis from x,y,z origin to controller pivot point 

z coordinate of jth controller mass center, (-l)-*h where j is an exponent 



+ 





Id 

Ih 


crew inertia matrix about x-, y-, and z-axes at the crew mass center 

disk inertia matrix about x-, y-, and z-axes at disk mass center 

hub inertia matrix about hub mass center referred to x^-, y^-, and z^-axes 

jth controller inertia matrix about controller axes at jth controller mass 
center 

total dynamic unbalance of spacecraft without controllers, 



I 


1=1 



|kJ translational spring constant matrix between disk and hub 

KrJ rotational spring constant matrix between disk and hub 

£ distance from controller pivot point to controller mass center 

m controller mass (see eqs. (10)) 

m c crew mass 

m^ disk mass 
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hub mass 


m h 

nij jth controller mass (j = 1, 2, 3, 4) 

m^ mass of additional spacecraft crew members 

4 

m-p total spacecraft mass, + m c + m^ + ^ mj 

j=l 

Qi generalized "force" associated with ith generalized coordinate 

ith generalized coordinate 

R inertial coordinates of disk coordinate axes system relative to overall mass 

center 

R c inertial coordinates of crew mass center relative to overall mass center 

R(j inertial coordinates of disk mass center relative to overall mass center 

Rg inertial coordinates of spacecraft mass center, j x' y' z'| T 

R^ inertial coordinates of hub mass center relative to overall mass center 

Rj inertial coordinates of jth controller relative to overall mass center 

? disk coordinates of hub coordinate axis system 

r c disk coordinates of crew mass center 

r^ disk coordinates of disk mass center 

i\j. hub coordinates of hub mass center 

r^ disk coordinates of hub mass center 

r j disk coordinates of jth controller mass center 

r kx ,r ky ,r kz spacecraft coordinates of crew mass m^ 
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x',y',z' inertial coordinate axes 

x h ; yh ,z h h ub C00r< Ainate axes, with origin at center of figure of hub 
Xj,yj,Zj coordinate axes of jth controller 

a = + «2 + ag + 

angular location of jth controller in x,y-plane (see fig. (12(d)) 
dj jth controller rotation rate about z-axis with respect to disk coordinate system 

Ao see equations (22) 


Acvj incremental rotation of jth controller about its steady-state value 

e = tan’l 

Ixz 

• = i/^x 2 + % 2 

?j x principal axis misalinement in x,z- plane 

r/y principal axis misalinement in y,z-plane 
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£ 

Pi 


1 o 

orientation of oo xv in x,y-plane, tan" 1 

y w x,o 


Az , 

coning rate less spin rate, w z l — ” 


vector from spacecraft mass center to jth controller expressed in spacecraft 
coordinates 




disk Euler angles (see fig. 12(a)) 


^h’^h’^h hub Euler angle rotations with respect to disk axes x, y, and z (see 
fig. 12(b)) 

hub Euler angle rotations with respect to inertial axes x', y’ , and z’ (see 
fig. 12(c)) 


4>i 

M 

W 

{"i} 


W. 


X,0 


10 - 


y,o 


ca X y - w w x,o + w y,o 


orientation of I r z in x,y-plane 

disk inertially referenced body rates |w x a>y u> z 

. x 

hub inertially referenced body rates x y z | 
inertial attitude rate of jth passive controller about controller axes 
initial attitude rate about x-axis 
initial attitude rate about y-axis 


— ( ) = ( ) + J2( ), where £2 is angular inertial rate vector of coordinate system used to 

dt , \ 
express ( ) 


transpose of bracketed matrix 


-1 


inverse of bracketed matrix 
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transpose of braced vector 
indicates a vector cross product operation 

Subscripts: 

r 

c crew 

d rotor or disk 

h hub 

j jth controller (j = 1, 2, 3, 4) 

o initial conditions 

s steady-state value of subscripted quantity 

x,y,z components of subscripted quantity along x-, y-, and z-axes 

ANALYSIS 

This section describes a mathematical model of a flexibly connected dual-spin 
spacecraft equipped with four pendulus masses designed to provide passive balance and 
spin axis control. Equations of motion, derived by the method of Lagrange, are pre- 
sented. The derived equations of motion, simplified by eliminating hub and flexibility 
terms, are then analyzed to define design conditions required for successful steady-state 
operation of the controllers with a spinning rigid-body space station and crew. Finally, 
controller sizing criteria are determined as a function of total static and dynamic 
unbalance. 



Mathematical Model 

The schematic model of the dual-spin spacecraft used in this study is shown in fig- 
ure 2. The model consists of a nonrotating (zero gravity) "hub," a slowly spinning rotor 
or "disk," and four pendulum-like arms (with end masses) free to rotate concentrically 
about the desired spin axis (z-axis). The rotating arms or passive controllers are 
deployed in two pairs on either side of the overall mass center along the z-axis. In nor- 
mal operation the controllers rotate with the disk and exhibit gradual relative movements 
only to counteract mass and/or inertial disturbances. Viscous dampers are incorporated 
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between the controllers and the disk to minimize settling time of the controllers after the 
introduction of a disturbance. 

The hub mass is connected flexibly to the disk mass through an arrangement of 
springs and dampers attached to the hub side of a bearing as shown in figure 3. Thus, 
spring and damping restraint exists for relative translations of the hub and disk along the 
x-, y-, and z-axes and for relative rotation of the hub and disk about the x- and y-axes. 
Relative rotations about the z-axis are unrestrained because of the bearing; frictional 
effects about the z-axis are assumed to be effectively compensated by application of an 
internal torque between the hub and disk. Disk, hub, and controllers are assumed to be 
rigid bodies. Flexibility exists only in the hub-disk connection previously described. 
Gravity gradient effects are assumed to be negligible for this analysis. 


Equations of Motion 

The equations of motion for a dual-spin spacecraft equipped with four passive con- 
trollers are derived in appendix A. The final form of these equations and the degrees of 
freedom represented are summarized below. 

x', y', and z' translational degrees of freedom of entire spacecraft: 


m 


T 


z' 


MM 


Equation (1) corresponds to equation (A24) and is written in the inertial system. 
0, 6, and i p rotational degrees of freedom of entire spacecraft: 


( 1 ) 


1H+MH + HMM - m h[ D 2][ r f][D 2 ] T [D 1 ] T {R h + Rg} - [D 2 ]f[D h ] 


-1 


MM 


^h ) 

+ | K R|j 0 h} + m 


<iMh] T m + 1 

j=l 


nij 


Di 


-1 


{Rj}) + n M[ r c][Di] _1 {R c } 



{ T d} + [ A ! ]{f} + [ r ] [d 2 ] { F h ^ 


( 2 ) 


Equation (2) corresponds to equation (A30) and is written in the disk coordinate system. 


9 



r x , r y j and r z translational degrees of freedom of hub with respect to disk: These 

equations are written in the disk coordinate system and correspond to equation (A25). 


m h 



+ ft e} + [ c lW + | K ]H = HW 


( 3 ) 


and rotational degrees of freedom of hub with respect to disk: These equa- 

tions are written in the hub coordinate system and correspond to equation (A3 1). 


iJK} 


m h 


r f 


P2 


iT 


[°l] T {Rh + Rg} + ["h] ph 


w hj 


Ih 


w h 


i-l 


ID, 


Fr b + k r 


A 

! 0 h 

>h 


= Tv 


(4) 


a: j (j = 1, 2. 3, 4) rotational degree of freedom of jth passive controller relative to disk 
coordinate system: This equation is written in the disk coordinate system and corre- 

sponds to equation (A19). 









sa j ca j " 


U) X U)y 




+ m j 


-e so-j 
l caj 
0 



+ CjOj = 0 


(j = 1, 2, 3, 4) (5) 


Stability Analysis of Passive Controller Operation With 
Rigid-Body Spacecraft 

This analysis considers a rigid-body space station equipped with four passive con- 
trollers. The steady-state controller response to static and dynamic unbalance of the 
spacecraft is derived along with conditions required for stable controller operation. Also, 
the effects of spacecraft coning on controller response are determined and controller siz- 
ing criteria are developed for spinning rigid-body spacecraft. 

A schematic of the space station is shown in figure 4 illustrating the vector location 
of the jth passive controller and the overall mass center in disk body coordinates. The 
three vectors have the relationship: 

P r Ai + ?j 
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The inertial acceleration of nij is 


d 2 ^ 


dt 


= ft + w x p- + 2u x p. + u x (w x p.\ 
2 J J J \ V 


where u> is the inertial angular velocity of the disk coordinate system written in disk 
coordinates. Substituting and Fj and their derivatives for Pj, p-, and /5j and 
writing the acceleration in matrix form yields 


d 2 p. 


dt 


or 


= A 1 + + 


oo 


(H + H) + 2 


" Aj + r, U 


00 


00 


Ai + 


) 


The moment equation for the passive controller about the z-axis can be written 

( 


Jj.zl^z + «j 1 + 


m; 


V 


9 2 p. 


9t 


+ C j“j = 0 


/z component 


l-£ SO! | 


q «■ “i) + m i j 1 c “ | (j A i j + j f j j + H(j 


A i + r J 1 1 + 


2 [“](j A 


1 > + l m 


+ HH({ A l} + { r i})j + C 3“i = 0 

Substituting the components of { A l}’ { A l}> { r j}> { }’ H’ 

and [clT] in this equation and collecting terms yields the basic equation governing control- 
ler motion 

(lj z + nij£ 2 )a!j + Cj«j + x £ saj + Aj y £ ca^j + m^A^ + (-l)^hj ^-cu x £ ca-j 

- w y £ saj) + (F z I jjZ + mjcF z ^ 2 + A 1>y £ safj + A 1)X £ cajj + 2m j w z |A lj y£ so- + A lx £ ca^ 

- 2m j A l,z( w y £ sa j + w x & c “j)+ m j w z 2 ( A l,x^ sa j - A l,y£ c “j) + m j w y 2£ sa j A l,x 

- mjC0 x 2 f co!jAj y + mj£ 2 saj caj^cuy 2 - w x 2 ) + mjW x u)y £ 2 ^c 2 Q!j - s 2 aj^ - £ sajA^y 


+ £ cajA]!^ 


+ mj^Aj )Z + (-l)3h)[-a) x cu z £ saj + u)yCo z H caj^ = 0 


( 6 ) 
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Equation (6) will be used first to examine the stability of controller steady-state 
response to spacecraft dynamic unbalance. Stability of controller response to static 
unbalance or mass center offset will follow. Finally, the effects of coning on controller 
response will be discussed. 

Response to dynamic unbalance .- Equation (6) is simplified by limiting inputs to 
pure inertia product disturbances (that is, Aj = Ai = Aj = o). Also, in the solution area 
of interest, co z ~ 0 and, since (u> x ,o>y) « o> z , second-order terms of cu x and u>y are 
negligible. These conditions reduce equation (6) to 

(l j,z + + c j“j + I XZ ,j f"x + w y^z) + Iyz,j(-"y " w x w z) = 0 ( 7 ) 


where the inertia products are defined as 
J xz , j = m j e CQ! j(-l) j h 

V,j = saj(-l)Jh 


(7a) 


Equation (7) governs the motion of the jth controller as a function of the spacecraft 
angular velocities and accelerations. The angular motion of the spacecraft, in turn, is 
governed by other equations which depend upon controller motion. The simultaneous 
solution of these equations is easily accomplished (for any particular set of conditions) by 
numerical methods, but a general solution is very difficult to obtain analytically. For this 
reason, a steady -state solution was sought analytically to determine the conditions required 
for successful operation of the controllers. 


The approximate spacecraft motion for fixed location of the controllers is given in 
terms of the following body rates and accelerations (ref. 2): 


Wi 


cv z 

= w x,o cos ^ “ w y,o sin " j _ j' 


00 


(jO z 

y = W X,0 sin I* + Wy j0 COS £t - — — 
= ^,0 


I xz (cos |t - 1) - I yz sin £t 


I xz sin £t + I yz (cos |t - 1) 




w x = ^( w x,o sin & + w y,o cos £t) + t ^ ( J xz sin £t + I yz cos £t) 


Wy = £(w x ,o cos |t - Wy )0 sin £t) - ^-y-(l xz cos & ~ Iyz sin £*) 


( 8 ) 
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where 



The quantities I xz and Iy Z are inertia products of the entire configuration. 
Equation (7) can be written for each of the four controllers, and the equations summed 
thusly: 


I kz + + c i"j + + “y“z) + lyzj^y ' “x“z) 

j=l 


= 0 (9) 


By defining a = ^ Q!j and stipulating that 

i=i 


*l,z “ l 2,z = *3,z ~ *4,z - lj,z 


Cf = C 2 = c 3 = C 4 = C 


m-^ = mg = m^ = m^ = m 


equation (9) combined with equations (7a) becomes 


(10) 


^ z + mf^a + Ca + mfih^cai - cai2 + 003 - 004! (w x - tOyO) z J 
+ meh(s«4 - so’2 + s <23 - sa^Wy + cu x u> z j = 0 (11) 

For the solution resulting from pure inertia product inputs, the initial attitude rates 
^uj x 0 ,Wy 0 j of equations (8) are set equal to zero and the following conditions apply: 


0(4 = aj ± 180 ° j 
a 2 = a 3 ± 180°^ 

Equation (11) becomes 

^Ij z + mf^ja + Com- 2mJ?h|co!4 + ca$j(to x - u>yU > Z J + 2m£h^sai + sogj^chy + ct> x cu z j = 0 


( 12 ) 
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The steady-state solution to this equation will occur when the forcing terms are zero; 
that is, 


2m£h(c0j + ca^\io x - o>yU> z j + 2m£h(S0j + sag^cby + cu x cu z j = 0 (13) 

By combining equations (8) and (13) with oj x Q = u>y )0 = 0, the steady-state condition can 
be written as 


where 



(14) 


The inertia product terms include products of inertia of the spacecraft without controllers 
and products of inertia of the controllers; thus, 

4 

Ixz = !r, z C 4>1 + ^ Ixz,j = !r,z c< t>l ‘ ZmHiJcoj + C0 3 ) 


j=l 
4^ 

lyz ~ lr,z S( P\ + Iyz,j = lr,z S( Pi ~ 2m#hjs0j + S0 3 j 

j=l ' 


Combining equations (14) and (15) yields 

fsin^ffj - £t - ejJ + sin ^3 - (jt ^ 


w z^ lz 

rrr z T 


i 2 + 1 2 
xz yz 


(15) 




I - 1 7 r ’ z 


sin^j - + sin^ L - 03J 


= 0 


(16) 


The first bracketed term of this equation cannot remain zero for steady-state a 
values, except for the trivial case of 0^ = -03 and 03 = -<*4 which applies only when 
inertia products of the spacecraft (the controllers being neglected) are zero. However, 
the radical can equal zero for I xz = 0 and Iy Z = 0. These conditions lead to the steady- 
state requirement 


14 



(17) 


where 


tti - CV3 = cos G 


G 4 IriZ 


2\2mfh/ 


An obvious constraint is 


or 


■1 = G = 1 


0 g — ,Z g 2 


(18) 


2m£h 

This constraint can be written as 


^ nijlh > Total dynamic unbalance 

j=l 


(19) 


The other steady-state requirement stems from setting the second term of equation (16) 
to zero which leads to 


sin^>i - a + sin^j - a ^ = 2 sin - oij - a 3^! c o s j _ '^' (~ ^ 1 + “3) 


0 


The cosine term cannot be zero without violating equation (17). Setting the sine 
term equal to zero results in the following additional requirement for steady state: 


ai + o' 3 = 2d) 


1 


Combining the two requirements leads to 
q?1 = 01 + ^ cos~ 1 g'| 

“3 = <h -^cos^G] 


(20) 


and because of the angular relationships of the controllers for a pure inertia product input, 
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o<2 = 0i - — cos _ 1g ± 180° 

2 

«4 = 01 + - cos _1 G ± 180° 
z 

The quantities a^, a^, a 3 , and a 4 are the steady-state angular locations of the 
four passive controllers in response to a pure inertia product disturbance to the rigid- 
body spacecraft. 

To determine stability conditions for the previous steady-state solution, each of the 
controllers is given an incremental perturbation in angle, angular rate, and angular 
acceleration from the steady-state condition and the system response is examined. By 
using an additional subscript s to indicate the previous steady-state solution, controller 
angles can be defined as 


a j = a js + Aa j 


a i = Aa i 


-\ 


(j = 1, 2, 3, 4) 


°i = Ao? j 


j 


The pure dynamic unbalance condition is maintained with the relationships 


Aoij = -Aa^ = -Aag = Aa^ 
Aq!j = -Ac^ = -Aig = Aar^ 
Aa^ = -Ad^ = -Adg = Ad^ 


A a 
4 



A a 

4 

J 


Also, by considering equations (12) and (21), 

-v 

sa + sq ! 4 s = 0 

sa 2s + S 0 ! 3s = 0 
co! Is + coi 4s = 0 

ca 2s + C 0 ! 3s = 0 


( 21 ) 


( 22 ) 


(23) , 
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Equations (21) are substituted into equation (7) to yield four moment equations - one 
for each controller. The equations for controllers 2 and 3 are summed and subtracted 
from the sum of the equations for controllers 1 and 4. This result is combined with equa- 
tions (10), (22), and (23) with the result 


Z + mJ2^Aa + C Aa + 2m0h|cu x - o)yUJ z j ^co^g - cag s j - 


sa ls + sa 3s) 


+ 2mfih(wy + co x c z ) (s a ls - sa^ + ^p(ca lg + c« 3s 


)l = ° 


(24) 


where 


w x - w y w z = 


Iz 


''l 


I - 1* I 


I xz sin £t + I yz cos £t - — I 


ly ^ 


(25) 


k>y + 0) X CU Z — - 


Iz 


I - Iz I 


Ixz cos £1 " Iyz s I n ~ 7~ Ixz 

lz 




and during the perturbation about steady state. 


Iy Z Aa ( ca ls - c “3s) 

j 

Substituting equations (25) and (26) into equation (24), ignoring the higher order 
term, and simplifying leads to 

|lj Z + mC^Aa + C Aa + Aafcj + C 2 cos £t^ = 0 

where 

2 (tin ^ 9 

C 1 = ^ (mCh; (1 - G) 
i - iz 

c 2 = ~Y~~Y~ p(mfh) 2 (3 - G) 

This nonlinear equation can be related to a Mathieu equation with known solutions by defin- 
ing a new independent variable 


Ixz - 


m£h 


A o /: 


so 


Is 


- so 


3s 


(26) 


(Aa)' 


(27) 
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T = £t 


and a new dependent variable 



with the result 

P + K]P + ^K 2 cos t)p = 0 

where 



The solution to this equation is discussed in reference 3. In general, the regions 
for a stable solution are defined by the condition Kq S 0 for small values of K 2 . This 
definition leads to 

C 2 g — ^ m 2 f 4 h 2 (l - G) (29) 

1 ■ !z 

Consideration of equations (18) and (29) indicates that G < 1 for finite damping. Thus, 
the vital condition for a stable solution is I > I z . 

These conditions are for the P solution. Of more importance is the A a solution 
which is modified by a stabilizing exponential (eq. (28)). However, for normal values of 
damping coefficient C, the exponential coefficient is much smaller than unity and the two 
solutions will have about the same degree of stability and the same stability conditions. 

Controller response to static unbalance .- Equation (6) can be simplified to determine 
stability of controller response to static unbalance by setting Aj z = 0 and eliminating 
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other small terms involving cu x , u>y, cl> z , Aj, and with the result 


h,z + m 


j j2 )“j + C j«j + m j U) z 2 ( A l,x £ so j - A l,y £ C0! j) = 0 


Conditions for a stable steady-state response of the controllers to static unbalance 
were determined from this equation by the method of the previous section to be 


Cj > o 


j=l 


Total static unbalance 


( 30 ) 


Effects of attitude rate on controller response .- The response of the controllers to 
a coning motion can be examined by determining the steady-state response of equa- 
tion (6) for the conditions of no unbalance and some initial attitude rate. For these con- 
ditions with ^ o x ,a>y^ « oj z and co z ~0, equation (6) reduces to 

^j,z + + c j®j + mfh j ( -c ^x + a) y w z) CQf j " ^y + w x w z) SQ, j 


J ) V y 


+ m^ sa^ CQ!j^a)y 2 - cu x 2 ^ + mjCU x Wy£ 2 ^c 2 Q!j - s = 0 


Substituting w x = w x Q c(£t) - cu y Q s(£t) and cu y = co x>0 s(£t) + Wy j0 c(£t) into this equa- 
tion and simplifying yields 


k 


+ m^laq + + mChjce X yCe z 


,z t ri 

where 


y sin^t + A - yy sin 2^t + A - a^j 


= 0 ( 31 ) 


co 


xy 


= fU 


+ CO 


y,o 


A = tan- 1(^2 


[co 


x,o j 


The two forcing terms disappear for 


o'j = |t + tan 






x,o. 
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That is, the coning motion generates controller forces and torques tending to stabilize 
the location of the controllers along the cross spin rate vector w X y. This vector pre- 

I z 

cesses in inertial space at the coning rate u> z — • The controllers cannot follow this 

motion because the damping term Cjij in equation (31) produces sufficiently large 
moments to keep the controllers essentially rotating along with the spinning body. As the 
body and controllers spin around the spin axis, the coning-generated forces in effect move 
around the body at the rate £ (the coning rate less the spin rate). Thus, the controllers 
experience a cyclic torque from these forces and respond with a small-amplitude oscilla- 
tion of frequency £. An approximation of this amplitude was determined from equa- 
tion (31) to be 


Controller oscillation amplitude due to coning effect = ± 


m£hco X yW z [hi 1 ) 



h 

i 



i 2 


(32) 


This result is an important one as it represents the lower limit of controller activity dur- 
ing spacecraft coning motions. This effect will be illustrated in the "Computer Simulation 
Results" section. The trim value of this oscillation is determined by balance require- 
ments as previously explained. Coning-induced controller oscillations cause only very 
small variations in spacecraft balance (less than two parts per thousand of the initial 
unbalance). 

In the section entitled "Response to Dynamic Unbalance," conditions required to 
counteract inertia product inputs were determined for u> = cu n = 0, since the coning 
effect on equations (12) was unknown. When the effect was determined to be small, the 
analysis was repeated to include the coning effects. Results were basically the same 
except that a new G incorporating attitude rates was defined 


fl - I, 


l z \ 2 t 2 

) w xv + ^ 

u > 7 / x y 


- 9T 

r.z ‘‘‘■x ,z 


I - I, 


cu. 


U> X y COS 


G = 


2(2nuOi) 2 


fh - j 

1 


(33) 


where I r z * 0 because equations (12) are not valid for l r z - 0. This value of G must 
satisfy the inequality -1 = G = 1 and equation (29). 
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Steady-State Response of the Controllers to Combined 
Static and Dynamic Crew Unbalance 

The steady -state response of the controllers to combined static and dynamic crew 
unbalance can be determined for steady spin about the desired spin axis as follows. The 
addition of coning motion has little effect on these results because of the small coning 
forces inherent in this application. 

The condition of static balance about the x- and y-axes is given by 


m c r c,x + m k r 


V + 1 m i 


e caj S = o 


i=i 


m c r c,y + m k r k) y + ^ “j* s «js = 0 

i=i 


The dynamic balance conditions about the x- and y-axes are given by 

4 r 

/ \ / \ 

m c r c 


+ A l,z) + m k r k,y( r k,z + A l,z) + 

m jf SQ!j s |hj + A 1}Z \ 

' X j-1 

\ / 


- 0 


m c r c,x 


^ r c,z + A l,zj 



" 

\ 

\ V 

) + m k r k,x( r k,z + A l,z) + l_j 

mj£ ca^h 

j + A l,z) 

' V 1=1 

- 

- 1 


= 0 


Let 


m = nij = m2 = nig = m 4 ^ 
h = -hi = h 2 = -h 3 = h 4 
From equations (34), (37), and (38), 


co? ls “ CQ! 2 s + cq, 3s ” Cfl, 4s ™cM m c r c,x r c,z + m k r k 


--U, 

mCh\ 


,x r k,z) 


c «ls + co, 2s + ca 3s + co, 4s = -^f( m c r c,x + m k r k,x 


(34) 


(35) 


(36) 


(37) 


(38) 


(39) 

(40) 
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From equations (35), (36), and (38), 


sa ls ~ sa 2s + sa 3s - sa 4s 


= ^( m c r c^c, Z +m k r k,y r M) 

sa ls + sa 2s + sa 3s + sa 4s = ” rnl( m c r c,y + m k r k,y) 
Combining equations (39) and (40) yields 

:,x| b + r c,zj + m k r k,x^* + r k,zj 


(41) 

(42) 


ca 2s + ca As = a l = 


2m£h 


1 


m c r c, 


c ^ls + ^3s= b l = -2^h 


m c r c,x 


( h - r c,z) + m k r k,x( h - r k,z) 


(43) 

(44) 


Combining equations (41) and (42) yields 

1 


sa„ + sa. = a 0 = -- — — 
2s 4s 2 2m £h 

1 


in r 
c c 


,y( h + r c,z) + m k r k,y( h + r k,z 


sa ls + sq, 3s =b 2 = - 


2m fh 


m c r c,y( h - r c,z) + m k r k,y( h ' r k,z 


(45) 

(46) 


Finally, from equations (43) and (45), the steady-state responses of controllers 2 
and 4 result 

■\ 


o- 2s = tan 


-1 a 2 ^ 


4s 


\ a ly 



(47a) 


Similarly, from equations (44) and (46), the responses for controllers 1 and 3 result 

A>\ 


«l s = tan 


■ l u 2 

1 l — + cos 


1 [+\! b l + b 2‘ 
2 


2 


a 3s = tan 


(47b) 
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These results compare closely with the computer simulation of a spinning and con- 
ing spacecraft reported in the "Computer Simulation Results" section. 

Controller Sizing Criteria for Combined Static and Dynamic Unbalance 

Coning motion is not considered in this analysis. However, the effects on control 
sizing are negligible. 

A diagram of mass centers and connective geometry showing the steady-state 
response of the controllers to a combination static and dynamic unbalance imposed by 
crew mass offsets, r c y and r cz , on a spinning spacecraft, is shown in figure 5. The 
static balance equation (moments about the z-axis) is 

m c r c,xy = ( m l + m 3 ) Ax l + |m 2 + m^Ax 2 

The dynamic balance equation (moments of centrifugal forces about an axis perpendicular 
to the plane of fig. 5 through m^j is 

m c w z 2r c ,xy( r c,z - Ah ) + ( m l + m 3j a, z 2 | Ax lj + Ah ) = ( m 2 + m 4 ja> z 2 ^Ax 2 j(h - Ah) 
Combining these equations with mj = m 2 = m 3 = m 4 = mj results in 

Ax _ m c r c,xy( h j - r c.,z) 

1_ 4 m j h 

^ _ m c r c,xy( h j + r c,z) 

2 " 4m jh 

For r c z >0, Ax 2 is larger than 

1 ’ 

lers. Since, in the extreme case, Ax 2 
inequality can be written 

g > m c r c,xy( h + r c,z) 

4mjh 

and 

4( mcrc . x y) + lh( mcr c,xy r c, Z ) 

■*Tor r c z = 0 , the Ax^ equation leads to the same result. 


Ax 4 and should be used to size the control- 
cannot exceed the controller length SL, an 
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or 


4 

) iml! = (Total static unbalance) + —(Total dynamic unbalance) (48) 

Lj j h 

j=l 

This relation is the sum of the static criteria of inequality equations (30) and the dynamic 
criteria of inequality (19) and shows that h controls the relative sensitivity of the con- 
trollers to dynamic unbalance and static unbalance. For example, increasing h 
increases the effectiveness of the controllers to reduce or eliminate dynamic unbalance 
without directly affecting their ability to control static unbalance. It should be pointed out 
that a violation of inequality (48) means only that the controllers are unable to counteract 
the excess of unbalance. 

In summary, conditions required for successful operation of the controllers as static 
and dynamic balancers of large rigid-body spacecraft include 

(1) Cj > 0 

(2) I z < I 

4 

(3) / nm# § (Total static unbalance) + -(Total dynamic unbalance) 

Lj i h 

j=l 

COMPUTER SIMULATION RESULTS 

The computer simulation (appendix B) considered a large, rigid-body space vehicle 
equipped with four controllers. Mass and inertial properties are presented in table I. 
Initially, the vehicle is assumed to be spinning slowly about its axis of symmetry in a bal- 
anced condition. At a given time (t = 10), 20 crew members (1500 kg) start moving radi- 
ally outward from the mass center in a direction midway between the x- and y-axes at a 
speed of about 0.85 m/s. Twenty seconds later they arrive at point x, y, z = 12, 12, 0. 

They immediately change their motion to 0.6 m/s in the z-direction and continue for 20 
more seconds at which time (t = 50) they stop at the spacecraft location x, y, z = 12, 12, 12. 
These motions of the crew introduce static and dynamic unbalance to the spacecraft. 

Typical simulation results are shown in figures 6 to 10. Figure 6 presents the 
angular motion history for each controller. To illustrate the frequency content of these 
curves, the second derivative of aq is also given. A basic period of some 60 seconds 
is evident throughout the simulation. This period represents the mass center translation 
mode. More noticeable over the last 300 seconds is the precessional motion mode char- 
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acterized by a period of about 25 seconds. This effect was described in the "Analysis" 
section. The controller is being driven by the coning motion of the spacecraft. The 
effect does not show up in the early part of the simulation because the restoring moments 
on the controllers due to the balancing action are overpowering. Controller oscillation 
amplitude associated with this response was measured to be about ±0.037°. The computed 
value from equation (32) is ±0.03°. As previously mentioned, the coning motion effect on 
the controllers is important in that it controls the lower limit of controller activity. The 
controllers cannot come completely to rest with respect to the spacecraft until the con- 
ing motion ceases. 

Figure 7 presents mass center offset in the x- and y-directions from the desired 
z-axis location. Also, the vector sum of these curves is shown to illustrate total offset 
of the mass center. Mass center offset levels for the same simulation without control- 
lers are also indicated for comparison on these plots. Comparisons show that the pas- 
sive controllers effectively reduce the static unbalance throughout the simulation. 

A similar result is evident from figure 8 which presents histories of principal-axis 
misalinement about the x- and y-axes and total principal-axis misalinement. These quan- 
tities are a measure of dynamic balance. Again, results of the same simulation with con- 
trollers eliminated are shown for comparison. The ability of the controllers to simulta- 
neously reduce or eliminate the static and dynamic unbalance is reflected in figures 7 
and 8. 

The inertial attitude response of the spacecraft to the crew motion disturbances is 
presented in figure 9. Part (a) of figure 9 shows the trace of the z-axis in the 00-plane 
for the spacecraft with controllers and for the spacecraft without controllers, both in the 
interval 650 = t = 680. The presence of the controllers clearly has eliminated much of 
the unwanted heading angle. 

The 00-response for "no controllers” in figure 9(a) is periodic and repeats every 
precession cycle (about 25.5-second period). The response with controllers also is cyclic 
at the precession frequency but changes from cycle to cycle due to movement of the con- 
trollers and the resultant change in mass and inertial properties of the overall spacecraft. 
This condition is evident from figure 9(b) which presents the history of the resultant head- 
ing angle. By t = 700, this heading response has reached its steady-state character (a 
small-amplitude coning motion) since controller motion has essentially ceased. 

Attitude Instability 

Energy dissipation results in attitude instability for a torque-free gyroscopically 
stabilized body if the spin axis is not the axis of maximum moment of inertia. (See ref. 4, 
for example.) As pointed out in the analysis section, the use of passive controllers with a 
rigid body is limited to the case where the moment of inertia about the spin axis is smaller 
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than the moment of inertia about the transverse axes. Thus, in the rigid-body application, 
the use of passive balancers implies a certain amount of attitude instability. Although 
there was no indication of attitude instability (cone-angle growth) in the crew-motion dis- 
turbance simulations, some of which extended up to 1200 seconds duration, the expected 
instability is very slow acting and would likely require a small corrective control torque 
over a long term history of disturbances. 

This type of attitude instability can be passively controlled for the case of the dual- 
spin vehicle previously described. Reference 1 shows that it is only necessary to provide 
a wobble damper in the hub or hub side of the bearing which will have an energy dissipa- 
tion rate sufficient to dominate the energy dissipation of the disk (structural plus control- 
ler damping). The spacecraft motion will then be stable and cone angle will gradually 
decrease. 


System Time Constants 

The computer simulation results presented in figures 6 to 9 represent a spacecraft, 
crew, and controllers with properties listed in table I. Responses to a given disturbance 
were plotted for some 700 seconds. The system time constant for this simulation was 
about 200 seconds. The ratio of total controller mass to total spacecraft mass was about 
3.5 percent. This ratio is unnecessarily large and can be reduced considerably. Fig- 
ure 10 shows the effect of controller mass and length on the system time constant. The 
upper plot illustrates a linear increase in the system time constant with controller length 
and the lower plot a linear increase in time constant with controller mass. The relation- 
ship in equation form is 

System time constant = 86 + 10 G + 0.042 5nij (49) 

Simulation results presented in previous figures are represented by a shaded symbol 
in each of the plots in figure 10. Note that controller mass could have been halved (to 
1600 kg) with an improved response time. Also, controller length can be decreased to 
improve response time. The only disadvantage to reducing controller mass and/or length 
is in violating the stability limits of equation (48). These limits are indicated in both plots 
of figure 10 by dashed curves developed from equations (48) and (49). These curves indi- 
cate combinations of £ and rnj for which two or more of the controllers are exercis- 
ing all their balancing capacity. Operations beyond this limit are not desirable because 
the excess of unbalance will cause small unwanted coning and nutational motions of the 
spacecraft. However, these motions will cease when the excess unbalance is removed. 

Ideally, controllers should be designed to operate near the dashed lines of figure 10 
and at a minimum time constant. However, each unbalance input will have different limit- 
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ing curves and the design may have to be based on the largest unbalance anticipated. This 
condition could result in large system response times for applications having widely vary- 
ing balance requirements. 

A means of avoiding large response times and controller ineffectiveness is to design 
the system for the relatively low levels of unbalance experienced in normal operations with 
provision for temporarily increasing controller length (during operation) in preparation 
for occasional activities requiring a relatively high level of balancing capability such as 
docking and resupply operations. This provision could be accomplished with a controller 
design incorporating telescoping arm sections. Variable controller mass would also be a 
solution to this problem - possibly through fluid transfer. 

The effect of controller damping on system time constant is presented in figure 11. 
As would be expected, increased damping in the range of practical interest tends to reduce 
the system time constant. For impractically large damping coefficients, however, the 
effect reverses, especially at near steady-state controller angles where the corrective 
centrifugal torques are relatively weak and unable to move the controllers against the 
damping at an adequate rate. 

CONCLUDING REMARKS 

Equations of motion have been derived for a flexibly connected dual-spin spacecraft 
equipped with four pendulumlike "passive controllers" for mass balance and spin axis con- 
trol. The derived equations, simplified by eliminating hub and flexibility terms, were 
analyzed to determine the conditions required for successful steady-state operation of the 
controllers with a spinning, rigid-body spacecraft. Results indicated that spacecraft 
inertia about the desired spin axis must be less than spacecraft inertia about the trans- 
verse axes. Positive damping of controller motion relative to the spacecraft is also 
required. The analysis also indicated that spacecraft coning motion induces very small 
controller oscillations which prevent the controllers from eliminating about two parts per 
thousand of the initial unbalance. Controller sizing criteria were determined as a function 
of balance requirements and related to limiting values of system time constant for a given 
unbalance condition. 

A generalized real-time computer simulation of a large, slowly spinning rigid-body 
spacecraft incorporating passive controllers has also been presented. Numerical results 
of this simulation show that passive controllers can successfully balance a class (spin 
inertia less than transverse inertia) of rotating rigid bodies undergoing large internal 
mass and inertial disturbances. These results also indicate a large reduction in space- 
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craft attitude error due to the action of the controllers. The ratio of total controller 
mass to spacecraft mass need not be more than 1 or 2 percent. 

Langley Research Center, 

National Aeronautics and Space Administration, 

Hampton, Va. , August 7, 1972. 
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APPENDIX A 


EQUATIONS OF MOTION 

/ 

Mathematical Model 

The mathematical model of a generalized dual-spin space station with passive con- 
trollers is shown in figure 2. The model consists of a nonrotating hub, a slowly spinning 
disk or rotor, and four pendulumlike arms (with end masses) constrained to rotational 
freedom about the desired spin axis (z-axis). The rotating arms or passive controllers 
are deployed in two pairs along the z-axis and their motions relative to the disk are 
damped. 

The hub mass is connected flexibly to the disk mass through an arrangement of 
springs and viscous dampers attached to the inner race of a bearing as shown in figure 3. 
Thus, spring and damping restraint exists for relative translations of the hub and disk 
along the x-, y-, and z-axes and for relative rotation of the hub and disk about the x- and 
y-axes. The presence of the bearing permits relative rotations about the z-axis to be 
unrestrained; frictional effects about the z-axis are assumed to be effectively compensated 
by application of an internal torque between the hub and disk. (See fig. 3.) Matrix repre- 
sentation of the spring and damping constants is as follows: 

Translational spring constant, newtons/meter: 



K x 

0 

0 


0 0 

Ky 0 

0 


Translational damping constant, newton-sec/meter: 



Rotational spring constant, newton-meters/radian: 




K R,x 

K R,xy 

^R,xz 

Kr 

-i 

= 

K R,xy 

K R,y 

K R,yz 



K R,xz 

K R,yz 

0 
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Rotational damping constant, newton-meter-sec/radian: 



Cr,x 

C R,xy 

C R,xz 


CR,xy Cr xz 
c R,y C R,yz 

C R,yz 0 


Although certain off-diagonal elements are listed as zeros, this is not a limitation 
of the mathematical model. Other coefficients could easily be used in these locations. 

Reference coordinates .- Four coordinate axis systems are used (fig. 12): Inertially 
fixed reference axes x', y', and z'; disk body fixed axes x, y, and z (origin at disk 
center of figure); hub body fixed axes x^, y^, and z^; and controller fixed axes xj, yj, 
and Zy Origin of the hub axis system is fixed coincident with the disk axis system when 
the spring-damper suspension system is undeflected. Disk angular motion is defined 
relative to the inertial axes by successive Euler rotations </> , 9, and xp, as shown in fig- 

ure 12(a). Similarly, hub angular motion is defined relative to the disk system by succes- 
sive Euler rotations cp^, 0^, and iph as shown in figure 12(b). Hub angular motion 
relative to the inertial axes is also computed as discussed in the section entitled "Hub 
Inertial Angles." 


Transfer matrices .- Quantities expressed relative to disk body coordinates can be 
referenced to the inertial coordinate system by premultiplication with the transfer matrix 
jDij; that is, 


r inertial 



where 




ci// c 6 

-sip c 9 

s 9 

D r 

= 

ci// s 6 s<p + si// c <p 

exp c<p - sip sQ sep 

-c 9 s < p 



si// s cp - exp s 9 ccp 

exp sc p + sip s 8 c <p 

c 9 cc p 


Similarly, quantities expressed relative to the hub coordinate system are referred 
to disk coordinates by the transfer matrix that is, 


r disk { 


D2 


"hub 
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where 


c ^h c0 h 



c ^h s0 h s ^h + s ^h c< ^h 
s ^ h s <^> h - c^ h S0 h c0 h 


-si^h ce h 


c ^h c 4 >h - s ^h s0 h s ^h 
c ^h S( ^h + S! ^h s0 h c< ^h 


se h 

- c e h s0 h 

c6 h c ^h 


Note that ^2] is with h-subscripted Euler angles. 

Quantities expressed relative to controller coordinate systems are referred to disk 
coordinates by the transfer matrix [03^; that is, 


where 


r disk 



Controller 


d 3 


caj 


SOI; 


~ Sa i 0 

CQ! j 0 

0 1 


the matrices [D2J, and [D3] are all orthogonal transformations and the matrix 

inverse is equal to the matrix transpose. 

The relationship between Euler rates and inertial body rates for the disk is 



0 



6 

* 


where 



c\p c6 
-si// c 6 


s 6 


si// 0 

ci// 0 

0 1 


The matrix transferring disk-relative hub Euler rates to disk-relative hub body 
rates is 
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ei// h c0 h st// h 0 

-s^h c0 h cxf/ h 0 

s0h 0 1 

Note that is [d] with h-subscripted angles. Neither [d] nor [d^J is 

orthogonal. 

Hub inertial body rates can be expressed in terms of Euler rates of the disk and hub 
as follows: 




Finally, controller inertial body rates are expressed in terms of disk rates and 
controller rate relative to the disk as 




1 ° 


<jJ x caj + ajy so! j 

hi- 

03 

T |“l + 0 


-w x SO! j + U)y COfj ) 



(“j 


W Z + “j ] 


All transfer matrices, some of their derivatives, and their inverses are listed for 
convenience in appendix C. 

Position coordinates of mass centers .- The mass centers of the disk, hub, crew, and 
individual balance masses are all located in disk coordinates as shown in figure 2 by the 
subscripted r vectors. The same mass centers are located in inertial coordinates 
relative to the total (or overall) mass center by the subscripted R vectors. The hub 
mass center is also located in hub coordinates | r f ^ as shown in figure 2 where the 
origin of the hub axis system is shown displaced from the disk axis system. The follow- 
ing relationships can be determined from figure 2 and knowledge of the transformation 
matrices 
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The mass balance equations for the entire spacecraft can be determined from fig- 
ure 2. Taking mass moments about the disk origin and expressing quantities in inertial 
coordinates results in 




APPENDIX A - Continued 


and 


where 


R = 


R - 


D, 


Dl 


A 1 j + 

Al| +2 


Di 


Dl 


A 1 + 


Dl 


A 1 


A ih~ 


m-p ' m d 


r d| + m cl r cl + /, ( m j r j[J +n M r h 


j=l 


‘t 

the location of total mass center in disk coordinates. Also m-p = m^ + m c + ^ mj, 

j=l 

jr^j. and jrjj are given constants, and jr c | is input as a time function. For the 
controllers, 


£ caj 

' £ sa j 



' # 

-£ofj saj 
• £dj CQ!j 
0 




f . 2 

-£ cajOj 

H cajQfj 

■ + 

-£ sajdj^ 

0 


0 



k - 


External forces and moments .- External forces are assumed to be zero during nor- 
mal operation of the space station. However, there are occasional periods during which 
orbit corrections, docking impacts, etc., will require application of external forces and 
moments to the station. Therefore, terms have been included in the equations of motion 
to supply external forces and moments both to the disk and to the hub. 
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Inertia properties .- The hub, disk, crew, and passive controllers are assumed to 
have constant inertial properties about their own axes as follows: 

Hub: 





X h,x 

-I h,xy 

" X h,xz 


K 

= 

_I h,xy 

X h,y 

_I h,yz 




-I h,xz 

_I h,yz 

x h,z 

Rotor or disk: 








X d,x 

_I d,xy 

-I d,xz 


V 

= 

-I d,xy 


_I d,yz 




-I d,xz 

_I d,yz 

! d,z _ 

Controllers: 









h,* 

0 0 ' 



[\ 

= 

0 

[ j,y 0 





0 

0 h,z 


Crew: 









X c,x 

~ l c,xy 

-X c,xz 


Ic 

= 

-I c,xy 

l c,y 

_I c,yz 




~^c,xz 

' x c,yz 

*c,z 


Langrange's Equations of Motion 

The space station with passive controllers has 16 degrees of freedom; one rotational 
degree for each of the controllers and three translational and three rotational degrees for 
both the disk and the hub. The analysis of this system has been simplified by choosing 16 
independent generalized coordinates to represent it. These independent coordinates are 
the controller rotation angles a^, a 2 , (* 3 , and a 4 , disk Euler angles <fi, 0 , and \J/, 
inertial coordinates of disk x', y', and z', disk coordinates of hub r x , ry, and r z , 
and disk-relative hub Euler angles 0^, 0^, and 
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The equations of motion are derived by substitutions of the appropriate terms in 
Lagrange's equations 



(i = 1, 2, . . 16) 


(Al) 


where the q^ represent the 16 generalized independent coordinates. Before illustrating 
the method with an arbitrarily selected coordinate, it will be necessary to define T, V, 
F^, and Q in terms of the basic physical quantities. 

Kinetic energy .- The kinetic energy of the space station includes the translatory 
and rotational kinetic energies of the disk / hub, crew, and passive controllers. It can be 
written in the form 


T - 1 -MM {«d}4B [%]{“} + i mh B4 (MBW 

4 m c{«c} T {“c}+|B T [ic]{"}+| 2( m j{“f} T {"j}) + ! 

i=i j=i x ' 


|m T {R g | ^Rg} 


(A2) 


For the rotational degrees of freedom, a more workable form of the energy equation will 
be used; namely, 






1 

+ — 
2 




■£W t HN + 3.£k 


2 pij^Vij,^ 

j=i x 


(A3) 


where 



Potential energy .- The potential energy of the space station consists only of the 
strain energy of the hub support springs due to relative displacement of the disk and hub. 
The potential energy can be written as 
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+ K R,xy^h e h + K R,xz^h^h + K R,yz 0 h^h ( A4 ) 

Dissipation function .- The dissipation function for the space base system involves 
translational and rotational terms generated by the hub support dampers and a rotational 
term for each of the passive controllers as follows: 



Generalized forces .- The generalized force Qj, associated with a generalized 
coordinate is given by 


Q i = (i=1 ’ 2 ’- ‘ -’ 16) 

where the forces Fj are applied at and along the coordinates Xj. For the dual-spin 
spacecraft application, the 16 independent generalized coordinates are a 2, a 3 , a 4 , 

<fy, 6, 4/, x', y', z', r x , r y , r z , <£ h , 6 h, and i// h . The forces are components of 
the external forces and torques applied to the disk and hub. The twelve xj coordinates 
are the inertial locations of the external force applications. 

The generalized forces were determined to be 

-£ sa!j T 

Qaj--— «?“) • M a = 1.2, 3, 4 ) m 

0 
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d ] t (W + NH + HN{ f 4) 



Qr,x| 

Q r,yj 

Qr,z) 



H + NK} 


^0,h] 

«*,» * + hfN} 

Q ^,h) 


(A7) 


(A8) 


(A9) 


(A10) 


Selecting Oj 
derivation yields 


as the generalized coordinate to illustrate the Lagrange method of 




acKj 


3a, 


+ m. 


H 


3a^ 




(All) 


By using the relationships 
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SR d 

II 

8 *c 


8 V 

II 

9R 

3 “i 


8i j 


9 O' 


da ■ 
3 


and 

4^ 

m dRl} + + m c{*c} + m h{^h} = 0 

3=1 

equation (All) reduces to 





T 

0 
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= 

0R 

da. 

(- m T ){Rj} + 

0 
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3 

1 


and the derivative is 


_d 

dt 





. 

T 

OR 
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da ■ 
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0 

0 
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Evaluation of the next term in equation (Al) yields 



By using the relations 


r. -| 


9r. | 
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r -| 


*1 ' 
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0R 
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+ 
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0aj 




da i 


8a j 


0R d 


0R C 


0R h 


0R 
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0Q? j 
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(A12) 


(A13) 
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and 



For the potential functions, 


(A14) 


_av 

da 


= 0 


] 


(A15) 


and from the dissipation functions, 


0F. 


80! 


] 


= c i A i 


The generalized force for this degree of freedom is 


(A16) 




■ {s “j 

£ CO- 


T 



0 


(A 17) 


Substituting equations (A12), (A14), (A15), (A16), and (A17) into equation (Al) and simpli- 
fying yields 




(A18) 
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By noting that 



' 



d_ 

9R 


9R 

dt 



90j 





" esQ! j 
• S. CO!j 

0 


and from equation (A24) 


M =■ ”> t [ d i] t K} 

equation (A18) can be written as 



-Si SO! j 
t CQ!j 
0 


[ d i ] t ({« j } + N) 


+ 





O), 


) sa i ca i 


- <Jl) X U)y 


[S 2 0! ; 



(j = 1, 2, 3, 4) (A19) 


This equation is the equation of motion for each of the four passive controllers. 


Equations of motion for the other 12 degrees of freedom, determined by the same 
method, are as follows: For the disk rotational degree of freedom (p , the Lagrange 
equation is 
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This equation can be shortened considerably by the use of the following equivalences: 



The shortened equation with partial derivatives of the oo terms expressed as functions 
of the transformation matrices becomes 



Combining this equation with similar equations obtained for the 6 and \p degrees 
of freedom results in the following matrix equation governing rotational motion about the 
overall mass center: 
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(A20) 


(A21) 


(A22) 
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Equation (A22) is derived from equation (A20) and the first of the derivative 
equations: 



(A23) 


Expressions (A23) are pertinent applications of the general rule that the transformation 
to inertial coordinates of the total derivative of a vector which is expressed in a rotating 
coordinate system is equal to the derivative of the transformed (from rotating to inertial 
coordinates) vector. The Lagrange equation for the x' coordinate is 




ttlrpX' = / 0 \ 


Di 


(f) 


L°J 


This equation plus similar equations obtained for the y' and z' degrees of freedom 
are combined to yield the following matrix equation governing translational motions of 
the overall mass center along the inertial axes: 


where 


m-j. 



fi'l 



t £, J 


For the r x degree of freedom, the Lagrange equation is 



+ K x r x 


+ ^x^x - \ 




»2 



(A24) 
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This equation and similar equations for Ty and r z are combined to form the matrix 
equation governing relative translation of the disk and hub 


™h[ D l] T {Rh) +[c]{r> +[K]{r) = ~( F > + [ D2 ]{ F h} 


which because of equation (A24) can be written as 


m h 


Dl 


T {R h + R g ) + [c]{r> + [K]{r} = 


D2 


(A25) 


The Lagrange equation derived for the hub-disk rotational degree of freedom (p^ is 
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(A26) 


By using the identity 


3D 2 


'®2‘ 

- 9 V 


_ a 4>h_ 


the equation can be combined. 


and equation (A24), the first terms on both sides of 


The resulting equation along with similar equations derived for the 6 ^ and ^ 
degrees of freedom can be written in the combined form 
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(A27) 
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where 



(A28) 


3D, 


3c£h 


<B> 




3D V 


30 h 


(B) 


3D, 


36 h 




Tr -i 




(A29) 



<B> + 



Equation (A29) is derived from equation (A27) and the second of equations (A23). 

Equation conditioning .- The cp, 9, and \j/ equations involve both disk and hub 
angular acceleration terms. These terms must be separated for purposes of solution. 
The hub acceleration term is eliminated by substitution of the 0^, 0^, and equa- 

tions as follows: 
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Premultiplying equation (A27) by [D] T 

d 2 

H 
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and (A29), and solving for the term yield 
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, combining with equations (A28) 
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This relationship is substituted for the jcu^j term in equation (A20). The result- 
ing equation is simplified by means of equations (A7), (A21), (A22), and the identities 
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with the result 
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developed from equations (A23) 
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(A30) 


Similarly, a combination of equations (A27), (A28), and (A29) allows the hub angular 
degrees of freedom to be expressed simply by the matrix equation 
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(A31) 


Hub inertial angles .- Hub angles with respect to an inertial frame of reference can 
be determined by two methods. After establishing an ordered set of Euler rotations 0j, 
0j, and »//j (see fig. 12(c)), the first method is to integrate the Euler inertial rates to 
obtain inertial angles from the expression 
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The second method, derived in reference 5, is the method used in the present investiga- 
tion. A vector quantity expressed in hub coordinates is transformed to inertial coordi- 
nates in terms of the 0, 6, and 0 and 0^, and 0^ systems as indicated by the 
equation 


\ r inertial 


V. 





This vector 
angles 0j, 


transformation can also be expressed as functions of the hub inertial Euler 
0j, and 0j. Equating the transformations yields 


c0j c0j -s0j cdj s0j 

C0J S0j S0j + S0j C0j C0J C0j - S0j S0j S0j -C0j S0j 

S0j S0j - cxpi S0j C0j C0J S0j + S0j S0j C0J C0J C0j 


D, 


Dc 


Equating comparable elements on the right and left sides of the equal sign provides a 
means of determining 0j, B\, and 0j in terms of the angles c p, 9, \p, 0^, 6^, and 
0^. These relationships are given in reference 5. 
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DESCRIPTION AND LISTING OF SIMULATION PROGRAM 
Computer Simulation 

The simulation was programed on a CDC 6600 digital computer which operates in a 
real-time mode and can be linked to actual control system or sensor hardware. The 
simulation was controlled from a program control station shown in figure 13 which 
includes a data entry keyboard, an on-line typewriter and time-history recorder, and a 
cathode ray tube (CRT) display console. 

The present program includes the spacecraft rotating element (disk) dynamics and 
the dynamics of four passive controller masses. Equations pertaining to the zero-gravity 
hub and isolation spring system are not included. These elements are being incorporated 
into a more extensive program for further use in control studies. The simulation required 
a storage of approximately 45 000 octal words and operated at 16 iterations (computer 
cycles) per second. A fourth-order Runge-Kutta integration scheme was used for the 
spacecraft and passive controller dynamics. A basic computing (integration) interval of 
0.03125 second was used. A flow diagram of the simulation follows. 
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INITIALIZATION 

Setup output parameter table 

Initialize input-output signals 

Initialize scale factors and simulation parameters 


RESET MODE 

Resets t = 0.0 

Resets derivative equations 

Resets CRT plot 

Unload CRT option 

Insert new data from keyboard 

Calculate initial rj for use in disk equations 



J 



HOLD MODE 

Derivative equations held at present values 



_ . .. . 


' 


OPERATE MODE 


Mass and/or inertial disturbance 
Option to erase and reset CRT display 
Rotating element (disk) equations of motion 


Compute disk Euler rates 
Compute x', y', and z' 

Compute |ai| 

Compute total torques on disk 
Compute R^, R c , and Rj 
Compute total mass acceleration 
Compute total inertia matrix 
Solution of disk derivative equations or Euler 
solution for disk (checkout option) 
Runge-Kutta disk integration 

, 4 pass integration loop 

' 

Passive controller equations of motion 


Compute rj, rj, and fj 
Compute ci j 

Runge-Kutta integration of (ij 

) 4 pass integration loop 

Auxiliary calculation 
Time-history recorder output 
CRT plot 

Real-time mode controls 



PRINTER OUTPUT MODE 
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Input 

Input for the simulation was supplied by the operator from the program control 
station through a data entry keyboard. The data entry keyboard provided capability to 
change parameters in central memory without removing the program from the computer 
and simultaneously displayed the value of the parameters on a digital display located on 
the program control station. These input variables were defined in a specific array VAR 
described in table II. 


Output 

Data output facilities included Brush time-history recorders, CRT display, and a 
high-speed line printer. A parameter listing and description, output formats, and expla- 
nations of output options are presented in tables III and IV. 

Recorder output .- Time-history recordings of spacecraft parameters (figs. 6 to 9) 
were generated by time-history recorders located adjacent to the program control station. 
Each time-history recorder had eight analog and nine discrete (event) channels. The 
analog channels were used to record desired data parameters. Time-history recorder 
channel assignments are shown in table III. 

Printer output .- A block of output data was stored on a disk file at specified time 
intervals denoted by the integer variable NT in terms of iteration cycles. Upon com- 
pletion of the run, all output was routed to the high-speed printer by depressing the 
"PRINT" control button located on the program control station. Output variables are 
identified by an asterisk in table IV which presents and defines all significant program 
variables. 

CRT output .- Another form of output was provided by a CRT display which gen- 
erated x,y-plots of spacecraft angles cp as functions of 9 as shown in figure 9. CRT 
plotting was done while the simulation was in a real-time status with a plotting frequency 
of FREQ in terms of iteration cycles. Since the amount of data required for a typical run 
(-700 sec) exceeded the limit on the CRT controller instructions, an option was included 
to erase the plot at any time and reinitialize the CRT so that only the desired part of the 
run was displayed. A hard copy of the CRT plot could be obtained if desired. 
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Program Listing 

The program listing is as follows: 

PROGRAM SPBASE( INPUT .OUTPUT > 

C 

C 


c 

* 

**#LD!SI*** 

OPTION 


C 


33 

- 

ALPHA D DOTS = 0.0 TO 

LOCK BALANCE ARMS 

c 


34 

- 

CREW RATE * SRCDX 


c 


35 

- 

CREW RATE * SRCDY 


c 


36 

- 

CRpW RATE * SRC.DZ 


c 


40 

- 

EULER DISK EQUATIONS ! 

FOR CHECKOUT 

c 


41 

- 

OPTION TO PLOT ON CRT 

(PHDK VS THDK IN DEGS ) 

c 


45 

- 

SETUP CRT IN OPERATE 


c 


46 

- 

UNLODE CRT DISPLAY 



C 

C 

COMMON/REALTIM/ANALGlN( 32 ) * DIGOUT (64 ) .LDISI ( 1 08 > * LD I SO ( 1 96 ) » 

I NOPpR » NHOLD .NRESET » NTERM « NPR I NT .NREAD 
LOGICAL LDISI .LDISO, LOGIC. VARCHNG 
DIMENSION VAR <40 ) , INtEG< 1 ) .LOGIC (4 ) . I VARBUF (5) 

D I MENS ION RR ( 6 . 24 ) . TxX ( 7 ) . T YY ( 7 > , TZZ < 7 ) 

DIMENSION ARDDX ( 7 ) . ARDDY ( 7 ) « ARDDZ ( 7 ) . BUFF ( 1 ) . T I M ( 3 ) 

DIMENSION I MAT ( 3 , 3 ) , E I GV ( 3 ) .EVEC (3.3) 

C 

REAL IMAT.IXYCG 

REAL MASSDI .MCI .Ml I ,M2! .M3 I . M4 I ,MTI , I 1 . 12, 13, 14 

REAL MASSD.MASSC.M1 .M2.M3.M4 ,MT 

real idxx, idxy, idxz, idyy. idyz. idzz. idxxo. idyyo. IDZZO. IDXYO 
real I DDXX . I DD YY , 1 DDzZ , I DOXY . I DDYZ . I DDXZ 
REAL Ml 0.M2O.M3O.M4O, I 1 O , I 20 . I 30 , I 40 

REAL IZTOT, IYTOT, IXTOT, IDIFX. IDIFY, IXYTOT, IXZTOT. IYZTOT 
REAL IDXZO.IDYZO. I XCG , IYCG, IZCG, I XZCG . I YZCG . MDUM 
REAL l 1 X » I 2X » I 3X .I4X.I1Y.I2Y. I 3 Y‘» I 4 Y 
LOGICAL DUMCG 
C 

EQUIVALENCE <VAR( 11.PHDK0 ).(VAR< 2).THD<0 ) , ( VAR ( 3),PSDKO ) 

EQUIVALENCE <VAR< 4 ),WXDKO ).(VAR( 5>.HfYD<0 ) , ( VAR ( 6)*WZDKO ) 

EQUIVALENCE (VAR( 7 ) « XPRO )«(VAR( 8),YPRO ) , ( VAR ( 9>.ZPR0 ) 

EQUIVALENCE < VAR ( 1 0 ) , XPRDO ) » (VAR( 1 1 > .YPRDO ) , (VAR( 12) .ZPRDO ) 

EQUIVALENCE (VARU3), IDXXO ) . (VAR( 14) « I DYYO ) . ( VAR ( 1 5 ) . I DZZO ) 

EQUIVALENCE (VAR ( 16) » AlO) . <VAR< 17) ,A20) ♦ (VAR( 1 8 ) .A30) , (VAR( 19) ,A40 ) 
EQUIVALENCE (VAR (20) , I 1 O ) « ( VAR ( 2 1 ) , 120) , (VAR (22 ) . 1 30 ) ♦ (VAR (23 ) . 140) 
EQUIVALENCE (VAR (24) .Ml O ) . ( VAR (25 ) ,M20) , (VAR (26 ) ,M30) , (VAR (27) .M40) 
EQUIVALENCE (VAR ( 28 ) , EL ) » ( VAR ( 29 ) . D I STZ ) . ( VAR ( 30 ) . C JO ) 

EQUIVALENCE (VAR (31 ) .SRCDXO ) , ( VAR ( 32 ) . SRCDYO ) . ( VAR ( 33 ) , SRCDZO ) 

EQUIVALENCE (VAR (34 ) .FREQ ) . ( VAR ( 35 ) .PLGA I N ) 

EQUIVALENCE (VAR (37) .MASSDO ) . ( VAR ( 38 ) . M ASSCO ) 

EQUIVALENCE (RR (6*1 )» A1 ).(RR<6,2 ). A2 ).(RR(6»3 ). A3 ) 

EQUIVALENCE (RR<6,4 ), A4 ) . (RR ( 6 . 5 ) » ADOTl ) , ( RR ( 6 » 6 ) . AD0T2 ) 

EQUIVALENCE ( RR (6.7 ) , AD0T3 ) , (RR ( 6 , 8 ).AD0T4) 

EQUIVALENCE ( RR ( 6 , 1 3 ) , XPR ) , (RR ( 6 » 1 4 ) , YPR ) , ( RR (6.15). ZPR ) 
EQUIVALENCE (RR (6,1 6 ) ,XPRD ) . (RR < 6, 17 ) »YPRD) » ( RR ( 6 » IB) ,ZPRD) 
EQUIVALENCE (RR (6,19 ) , PHDK ) . (RR ( 6,20 ) .THDK ) . (RR (6. 21 ) .PSDK ) 
EQUIVALENCE ( RR (6,22 ) .WXDK ) . (RR (6,23 ) » WYPK ) ♦ (RR(6» 24 > . WZDK ) 
EQUIVALENCE ( INTEG( 1 >, I SCAN ) 

EQUIVALENCE (LDISI (48 )♦ INTABLS ) 


52 



APPENDIX B - Continued 
c 

C***» SECTION C. INITIALIZATION OF REAL TIME SYSTEM 

CALL CYCLE ( 90006S ) 

NT = 32 

CALL READOUT < 4 • NT « T » SRC X . SRC Y ,SRCZ > 

CALL READOUT < 6 . NT . WXOK . WYDK . WZDK . PHDK . THDK , PSDK ) 

CALL READOUT ( 6 . NT . WXODK , WYDDK . WZ DDK .A1X.A1Y.AIZ) 

CALL READOUT <6. NT. A 1 A. A2A, A3A , A4 A .ETAXZ .ETAYZ ) 

CALL READOUT <6. NT, ADoTl , AD0T2 . ADOT3 . A00T4 .DELE »ET AXYZ ) 

CALL READ0UT(6.NT,ADd0T1 . ADD0T2 • ADD0T3 , ADD0T4 « CMO . CON ) 

CALL READOUTS. NT. THfTH.DELH.THETZ.DELZ.THETI , DEL I ) 

CALL READOUT < 3 . NT ♦ E I GV < 1 > . E I GV < 2 ) . E I GV < 3 ) ) 

CALL RTROUTE<MF.90034S ) 

CALL I NOUT ( ANALG I N, 32 » D l GOUT .42 . LD 1 S I . 88 . LD I SO , 1 96 ) 

CALL XOSPLAY (LDISI «LDt SO » V ARCHNG , I TYPE « IVAR3UF, INTABLS) 

CALL DATABLXIVAR, 40 » INTEG. 1 .LOGI C.4 . ANALG I N < 32 . D I GOUT , 42 . 

1 LDISI ( 1 ) .88.LDI S0( 1 ) , 1 96 > 

C 

C**** CLEAR INDICATOR L I TES 
DO 8F IND=1 .196 

85 LD I SO ( IND) = .F. 

C**** CLEAR DISCRETE INPUTS 

DO 86 I ND = I . 108 

86 LDISI ( IND) = .F. 

C**** CLEAR DA CONVERTERS 

DO 87 IND=1 .42 

87 DIGOuT (IND) = 0. 

CALL NAMECRT<6LCRTTPF,ERR ) 

ASSIGN 90001 TO NOPER 
ASSIGN 90002 TO NHOLD 
ASSIGN 90003 TO NRESpT 
ASSIGN 90004 TO NTERm 
ASS ION 90014 TO NPRINT 
ASSIGN 90015 TO NREAD 
C 

C**** SECTION D. CONSTANfS AND INITIAL PARAMETERS 
C PRINT 16 

16 FORMAT ( 6X* SPACE BASE S I MljL AT I ON*5X* JOB » 43. 77777 » 75000 . A2718. 

1 13043. 1 .C.W.MARTZ.B1232 R125*) 

TIM( 1 )=4RXTIM J> TlM(2)=4RXE= * TIM(3)=4RX. 

NUMBER* I NTEG=K0UNT=0 
I SCAN = 32 

c ****** RECORDER scale FACTORS 

SF A 1 Y= 10. * SF A ] Z= 1 0 . * SFA 1 X= 10. 

SFTH = 5. * SFT 1*5. * SFDEL I = 1 ./I 80 . 

SFC0N=5. 

SFCMO*5. 

SFET A = 5 • 

SFETAX=5. 

SFET AY = 5 • 

SFCONE=5 • 

SFTHfTZ=2.5 
SFMBA=1 • / 1 80 • 

SFCRFWs.Ol 
SFANG* 1 • 

SFACC* 1 000. 

SFRATEol . 
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c 

c ***************** INITIALIZATION 

T INC=HH=.031 25 
SX=1 • /6 . 

BILL=50. * TMARTZ=0.0 
TIMER=I 0. 

DUMCO=.F. 

FREQs 16* 

PLGA IN=*2 
CTIMF=1 00. 

SRXO=SRYO=SRZO=0.0 

SROXO=SRDYO=SRDZO=0.o 

C ***************** INITIALIZATION DISK ********** 

M A SSf)0 = 350000 . 

PHDKO=THDKO=PSDKO=0.o 

WXDKO=WYDKO=0.0 

WZDK0=.5 

IDXXO= lDYY0=38000000o. 

I DZZO= I 90000000 • 

I DXY0 = I 0XZ0 = I DYZ0=0 * O 
I DXYO=0 • 

IDXY=IDYZ=IOXZ=0.0 
SRSX=SRSDX=SRSDDX =0.0 
SRSY=SRSDY=SRSDDY=0.0 
SRSZ=SRSDZ=SRSD0Z=0 . O 
RDDX=RDDY=RDDZ=0. 0 
FXDKsF YDK=FZDK=0 . 0 
TXDKsTYDK=TZD<xO, 0 

XPRO=YPRO=ZPRO=XPRDO=YPRDO=ZPRDO=0.0 
XPRDD = YPRDD = ZPRDO = 0 . n 

C ********************** INITIALIZATI ON FOR MASS BALANCE SYSTEM 

A 1 0= A20= 1 .570796 
A30=A40=-1 .570796 
Ml 0 =m20=M30=M40=3200, 

CJO=4000. 

EL = 1 * s . * DISTZ=7.5 

I 1 X= t 2X= I3X= I4X = 71 0. 

I 1 Y=l2Y=I3Y=I4Y=7800, 

110=120=1 30= I 40 =7800. 

C ********************** INITIALIZATI ON FOR CREW 

MASSC0= 1500. 

SRCDxO=SRCDYO=SRCDZO= .6 

C. 

90003 CONTINUE 

CALL READY 

C**** SECTION E. INITIALIZATION OF INTEGRALS 
C ***************** PP4£T LOOP 
T = 0.O 
T I NC=HH 

nfreo=freq 

N2=l 0*NFREQ 
TCOUNT=0. 

C 

C ****** SETUP CpT PLOT ( PH vS TH ) 

IF(DUMCG) GO TO 17 
CALL HALT 
CALL ENOPLOT 
CALL UNLODE 
CALL CLRPLOT 


*** 
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CALL CRTPLOT ( 1 * 1 « NFReQ « 0 ♦ 0 ♦ THDEG »PLGA I N* 0 « l OLTHDK «PHDEG«PLGA 

1 IN.O, 10LPHDK ) 

CALL CRTPLOT ( 1 * 1 « N2 • 3 O 8 » 1 » THDEG • PLGA I N« 0 • 1 OLTHDK «PHDEG»PLGA 

1 IN.O, 1 OLPHDK ) 

CALL REAOY 
17 CONTINUE 
DUMCG=.T. 

****** UNLOOE CRT SCREEN 

IFt.NOT. LD1SI(46M GO TO 50003 

CALL HALT 
CALL UNLOOE 
CALL READY 
50003 CONTINUE 
C 

C ****** SET IN INITIAL CONDITIONS 

TSAvf=T 
tmartz=t 

XPR=yPRO £ YPR=YPRO * ZPR=2PR0 

XPRD=XPRDO * YPRO* YPRDO * ZPRD=ZPRDO 

C ************************* DISK *** 

PHDK=PHDKO * THOK=THDKO $ PSDK=PSDKO 

WXDK=WXDKO * WYDK=WYDKO * WZDK-WZDKO 

SRX=SRXO S SRY=SRYO £ SRZ=SRZO 
SRDXsSRDXO £ SRDY=sRDYO S SRDZ=SRDZO 

SRCX=SRCDX=SRCDDX=0.0 
SRCY=SRCDY=SRCOOY=0.n 
SRCZ=SRCDZ=SRCDOZ= 0 .n 

TXX ( 1 >=TXX(2>=TXX(3)=TXX(4)=TXX{5>=TXX(6)=TXXf7>=0.0 
TYY ( 1 }=TYY(2)=TYY(3)=TYY(4)=TYY(5)=TYY(6)=TYY(7)=0.0 
TZZ ( 1 ) = TZZ 1 2 ) = TZZ ( 3 ) =TZZ ( 4 ) = TZZ ( 5 ) =TZZ 16 ) =TZZ ( 7 ) =0 • 0 
c ************************* MASSBAL • *** 

wxddk=wyddk=wzddk=o.o 
ADOT 1=ADOT2=ADOT3=ADOT4=0.0 
ADDOTl = AODOT2= ADDOT3= AODOT 4 = 0«0 
WXDHOLD=WYDHOLD=WZDH0L0=0.0 
MASSO=MASSDO * MAScC=MASSCO 
A 1 = A 1 0 $ A2=A20 £ A3=A30 * A4=A40 

11=110 * 12=120 £ 13=130 S 14=140 

M 1 =M I O * M2=M20 £ M3=M30 * M4*M40 

CJ1 =CJ2=CJ3=C J4=C JO 
I 1 X=I2X=I3X=14X=71 0. 

I 1 Y= I 2Y= I 3Y= I 4 Y=7800 . 

SR 1 X = SR 1 Dx = SRl DDX= 0 • O 
SR I Y=SR 1 0Y=SR1 DOY=0 • O 
SRlZ=SRlDZ=SRlDDZ=0.o 
SR2X=SR2Dx=SR2DDX=0.o 
SR2Y=SR2DY=SR2DDY=o.o 
SR2Z=SR2DZ=SR2DDZ=0.O 
SR 3 X=SR 3 DX=SR 3 DDX= 0 «o 
SR3YsSR3DY=SR3D0Y =0 • O 
SR 3 Z=SR 3 DZ=SR 3 DDZ= 0 «o 
SR4X=SR4DX=SR400X=0« 0 
SR4Y=SR4DY=SR4DDY=0. o 
SR4Z=SR4DZ=SR4DDZ=0«0 

C ****** CALCULATE INITIAL CONDITIONS 

CA 1 =COS ( A 1 ) S CA2 = C0S(A2) £ CA3 = C0S(A3) £ CA4=C0S(A4) 

SA1=SIN(A1) £ SA2=SINIA2) * SA3=SIN(A3) S SA4=SIN(A4) 

SR 1 X=EL*CA 1 
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SR 1 Y=EL*SA 1 
SR 1 Z=— D I STZ 
SR2X=EL*CA2 
SR2Y=£l*SA2 
SR2Z = D I STZ 

SR3X=EL*CA3 
SR3Y=EL*SA3 
SR3Z = — D I STZ 

SR3Z=— D I STZ— 5 • 

SR3Z=— D I STZ* ! .2 
SR4X=EL*CA4 
SR4Y=EL*SA4 
SR4Z= 01 STZ 

SR4Z=D I STZ+5 • 

SR4Z=0 I STZ* 1 .2 

MT=MASSD + MASSC + Ml + M2 + M3 + M4 

I F (MT • NE • 0,0) MTI=i,/MT 
CPSDK=COS (PSDK ) 

CTHDk=COS (THDK ) 

CPHDK=C0S (PHOK ) 

SPHOK = S T N ( PHOK ) 

STHDK=SIN(TH0K) 

SPSDk*SIN(PSDK> 

SECTHOK = 1 ./CTHDK 

c ********* THE d matrix 
D1 1 =CPSDK*CTHO< 

D12=SPSDK 

02 1 =— SPSDK*CTHDK 
D22=CPSDK 
D31 =STHDK 
033*1,0 

C ********** thf O - I MATRIX 
0011 =D1 1 
DOl 2=D2 1 
D013=STHDK 

0021 =CPSOX*STHDK*SPM0K + SPSDK*CPHDK 
D022=CPSDK*CPHDK - SPSDK*STHDK*SPHDK 
0023=— CTHDK*SPHDK 

D031 =SPSDK*SPHOK - CPSDK*STHDK*CPHDK 
D032=CPSDK*SPH0K + SPSDK*STHDK*CPHDK 
D033 = CTHDK*CPHDK 


C 


***********************-************ DISK EULER RATES ****** 


DPHDk=CPSDK*SECTHDK*WXDK - spsdk*secthdk*wydk 
OTHDK=SPSOK*WXDK + CPSDK*WYD< 

OPS Dk=—CPSDK*STHDK* SECTHOK* WXDK + SPSDK*STHDK*»SECTHDK*WYDK+WZDK 
********** THE 0 - 1 -DOT MATRIX 
D0D1 1=-DTHDK*CPSDK*StHDK - DPSDK*SPSDK*CTHDK 
D0D1 2=+DTHDK*SPSDK*STHDK - DPSDK*CPSDK*CTHD< 


0001 3=+DTHDK*CTHDK 

DOD21 =+DPHOK* <CPSDK*STHOK*CPHOK - SPSDK*SPHDK) + 
1 *SPHDK - DPSDK* (SPSDK*STHOK*SPHDK - CPSDK*CPHDK) 
DOD22=-DPHOK* (SPS0K*STH0K*CPHDK CPSDK*SPHOK) - 
2*SPH0K - OPSOK*(CPSDk*STHDK*SPHDK + SPSOK*CPHDK) 
D0D23-— DPHDK*CTHDK*CPHDK + DTHDK*STHDK*SPHO< 
00031 =+DPHDK* (CPSDK*«;THDK*SPHDK + SPSDK*CPHDK) - 
3*CPH0K + DPSDK* (SPSD<*STHDK*CPHDK + CPSDK*SPHDK ) 
D0D32=-DPHDK* (SPSDK*STH0K*SPHDK - CPSDK*CPHDK) 
4*CPHqK + DPSDK* < CPSDK*STHDK*CPHDK - SPSDK*SPHDK ) 
D0D33=-DPHDK*CTH0K*SPHDK - DTHDK*STHDK*CPHO< 


DTHOK*CPSDK*CTHDK 

DTHOK*SPSOK*CTHOK 


DTHOK*CPSDK*CTHOK 

DTHDK*SPSDK*CTHOK 
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c 

c 

90002 CONTINUE 

C**** SECTION F . HOLD CONTROL 
WXDOK=WXDHOLO 
WYDOk»WYOHOLO 
wzdok = WZDHOL d 
c 
c 

90006 CONTINUE 

SECTION G. OPERATE LOOP 
IF(LOlSI (17) > DUMCG=,F. 

SRCDx=SRCOY«SRCOZ=O.A 

C ****** CREW MOTION DISTURBANCE 

IF<LOISI (34 ) ) SRCOXsSRCDXO 
IF(L0ISI (35) ) SRCDYsSRCOYO 
IF (LOI SI (36) ) SRCDZ=SRCDZO 
IFIT.GE.l 0. .AND.T.LT.30. >SRCDX=.6 
IF (T.GE.l 0. .AND.T.LT.30. )SRCDY=.6 
IFIT.GE.30. .AND.T.LT.50. )SRCDZ=.6 
IF (.NOT. LDISI ( 17) ) GO TO 40 
SRCX=SRCX + HH*SRCDX 
SRCY=SRCY + HH*SRCDY 
SRCZsSRCZ + HH*SRCOZ 

40 CONTINUE 
C 

C ****** ERASE AND SETUP CRT DISPLAY 

C 

IF (.NOT. LDISI (45)) GO TO 42 

CALL HALT 

CALL ENDPLOT 

CALL UNLODE 

CALL CLRPLOT 

I T I MsT 

JTIM=(T+HH - I T I M )* 1 00 . 

41 CONTINUE 

CALL ENABLE (41 S) 

CALL CRT CODE ( 2 « T I M ( 1 )* 100.. 990. ) 

CALL ENCODE I ( ITIM.4, 150. .990. ) 

CALL CRTC0DE( 1 .TIM (3 ) . 190. .990. ) 

CALL ENCODE! ( JTIM.2. 1 96.. 990. ) 

CALL MARK250 

CALL CRTPLOT ( 1 . 1 . NFRFQ , 0 « 1 , THOEG , PLGA I N. 0 ♦ 1 OLTHDK 
1 IN.O. 1 OLPHDK ) 

CALL CRTPLOT (1.1 »N2 . 30B. 1 « THDEG . PLGA I N, 0 . 1 OLTHDK 
1 IN.O, 1 OLPHDK ) 

CALL READY 

42 CONTINUE 

C 

c ****** BEGIN DISK CALCULATIONS 

INT*t 

27 CONTINUE 

MASSOI = 1 ./MASSO 
CPSDK=COS(PSDK) 

CTHDK=COS (THDK ) 

CPHDX=COS (PHDK ) 

SPHDK=S I N ( PHDK ) 

STHDK=S1N(THDK) 


. PHDEG.PL GA 
, PHOEG.PLGA 
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SPSDK*S IN (PS OK ) 

SECTHOK = 1 • /'CTHDK 
i ********* THE D MATRIX 
I D1 1 *CPSDK*CTHDK 
D12*SPSDK 
021 =-SPSDK*CTHDK 
022-CPS0K 
031 =«THDK 
033*1 .0 

****-****** THE 0- DOT MATRIX 
DOl 1=-CPSDK*DTHDK*STHDK - CTHDK*DPSDK*SPSDK 
DO 1 2=0PS0K*CPSDK 

0021 =SPSDK*DTHDK*STHnK - CTHDk*DPSDK*CPSDK 

D022=-0PS0<*SPSDK 

DD31=DTHDK*CTHDK 

********** THE 0 - INVERSE MATRIX 
Dill = CP SDK* SECTHOK 
D I 12=-SPSDK*SECTH0K 
0121 =SPSDK 
D 1 22 = CPSDK 

D I 31 a-CPSDK*STHDK*SECTHOK 
DI32=SPSDK*STH0 K*SECtHDK 
0133=1 .0 

**************************************** DISK EULER RATES 

DPHDK= DI11*WXDK+ D I 1 2*WYDK 

DTHDK= DI21*WXDK + nI22*WYDK 

DPSDK= 0131 *WXDK + oI32*WYDK + WZDK 

othdk2=dthdk*dthdk 

DPHOK2 = DPHDK *DPHDK 

DPSDK2=DPSDK*DPSDK 

PDA 1 =DD 1 1 *DPHDK + DDl2*DTHDK 

PDA2=DD21*DPHOK + DD?2*DTH0K 

PDA3=DD31 *DPHDK 

DDPHDKx D I X 1* (WXDDK-pDAl )+DI 12* ( WYDDK— PD A2 ) 

ODTHOK = D I 21 * (WXDDK— PDA 1 ) +D I 22* ( WYDDK-PDA2 1 
DDPSDK= D I 31 * ( WXDDK— PDA 1 ) +D I 32* C WYDDK— PD A 2 1 +WZDDK— PDA3 
********** THE D - 1 MATRIX 
DO 1 1=011 
0012=021 
DO 1 3=STHDK 

D021 =CPSDK*STHDK*SPHpK + SPSDK*CPHDK 
D022=CPSDK*CPHDK - SPSDK*STHDK*SPHDK 
D023=-CTHDK*SPHDK 

D031=SPSDK*SPHDK - CPSOK*STHDK*CPHDK 
D032=CPSDK*SPHOK + SPSDK*STHDK*CPHDK 
D033=CTHDK*CPHDK 

********** THE D - 1 -DOT MATRIX 

DOD1 1 =-DTHDK*CPSDK*STHDK - DPSDK*SPSDK*CTHD< 

OOD1 2=+DTHOK*SPSDK*STHDK - DPSDK*CPSDK*CTHD< 

D0D1 3=+DTHDK*CTHDK \ 

D0D21 =+DPHDK* (CPSOK*cTHDK*CPHOK - SPSDK*SPHDK ) + DTHDK*CPSOK*CTHDK 
1*SPH0K - DPSDK* ( SPSDK*STHDK*SPHDK CPSDK*CPHDK) 

D0022=-DPHDK* (SPSOK*sTHOK*CPHDK + CPSDK*SPHDK ) - DTHDK*SPSOK*CTHDK 
2*SPH0K - DPSDK* (CPSDK*STHOK*SPHDK + SPSDK*CPHDK ) 

D0D23= -DPHDK*CTHDK*CpHDK + DTHDK*STHDK*SPHD< 

D0D31 =+DPHDK* (CPSDK*sTHDK*SPHDK + SPSDK*CPHDK 1 - DTHDK*CPSDK*CTHDK 
3*CPHDK + DPSDK* (SPSDK*STHDK*CPHDK + CPSDK*SPHDK) 

D0D32=-DPHDK* (SPSDK*?THDK*SPHDK - CPSDK*CPHDK) + DTHDK*SPSDK*CTHDK 
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4*CPHD< + DPSDK*(CPSDk*STHDK*CPHDK - SPSDK*SPHDK) 
DOD33=-DPHDK*CTHDK*SPHDK - DTHDK*STHDK*CPHDK 
C ********** THE D - 1 - DOUBLE DOT MATRIX 

DODDl 1 =-DDTHDK*CPSDK*STHDK - DDPSDK*SPSDK*CTHDK + 2 . *DTHDK*DPSDK* 

1 SPSDK*STHD< - (DTHDK? + DPSDK2 > *CPSDK*CTHDK 
DODDl 2=+DDTHDK*SPSDK*STHDK - DDPSDK*CPSDK*CTHDK + 2 .*DPSDK*DTHDK* 
2CPSDK*STHDK + (DTHDK2 + DPSDK2 ) *SPSDK*CTHDK 
* DODDl 3=+DDTHDK*CTHDK - DTHDK2*STHDK 

DODD21 =+DDPHDK*(CPSDK*STHDK*CPHDK - SPSDK*SPHDK) + DDTHDK*CPSDK* 
3CTHDK*SPHDK - DDPSDK* (SPSDK*STHDK*SPHDK - CPSDK*CPHDK ) — ( DPHDK2 + 
4DPSDX2 )* <CPSDK*STHDK*SPHDK + SPSDK*CPHDK ) - DTHDK2*CPSDK*STHDK* 
5SPHDX + 2.*DPHDK*DTHOK*CPSDK*CTHDK*CPHD< - 2 • *DTHDK*DPSDK*SPSDK 
6*CTH0<*SPHDK - 2.*DPSDK*DPHDK* < SPSDK*STHDK*CPHD< + CPSDK*SPHDK) 
D0DD22=-DDPHDK* (SPSDX*STHDK*CPHDK + CPSDK*SPHDK ) - DDTHDK*SPSDK* 
7CTHDK*SPHDK - DDPSDK* < CPSDK*STHDK*SPHDK + SPSDK*CPHDK ) + (DPHDK2 + 
8DPSDK2 )* (SPSDK*STHDK*SPHDK - CPSDK*CPHD< > + DTHDK2*SPSDK*STHDK* 
9SPHDK - 2.*DPHDK*DTHnK*SPSDK*CTHDK*CPHDK - 2 . *DTHDK*DPSDK*CPSDK* 
ACTHDK*SPHDK - 2 • *DPHDK*DPSDK* < CPSDK*STHDK*CPHDK - SPSDK*SPHDK ) 
D0DD23=-DDPHDK*CTHDK*CPHDK + DDTHDK*STHDK*SPHDK + (DPHDK2+ DTHDK2 ) 
B*CTHDK*SPHDK + 2.*DPH0K*DTHDK»STHDK*CPHDK 
D0DD31 =+DDPHDK* <CPHDK*STHDK*SPHDK + SPSDK*CPHDK) - DDTHDK*CPSDK* 
CCTHDk*CPHDK + DDPSDK* (SPSDK*STHDK*CPHDK + CPSDK*SPHDK ) + (DPHDK2 + 
DDPSDK2 )*(CPSDK*STHDK*CPHDK - SPSDK*SPHDK ) + DTHDK2*CPSDK*STHDK* 

ECPHDK + 2«*DPHDK*DTHoK*CPSDK*CTHOK*SPHDK - 2. *DPHDK*DPSDK* (SPSDK* 
FSTHDK*SPHDK - CPSDK*cPHOK) + 2 . *DTHDK*DPSDK*SPSDK*CTHDK*CPHDK 
DODD32 =-DDPHDK* ( SPSDk*STHDK*SPHDK - CPSDK*CPHDK) + DDTHDK* SPSDK* 
GCTHDK*CPHDK + DDPSDK* ( CPSDK*STHDK*CPHDK - SPSDK*SPHDK) - (DPHDK2 + 
HDPSDK2 )* (SPSDK*STHDK*CPHDK + CPSDK*SPHD< ) - DTHDK2*SPSDK*STHDK* 
ICPHDK - 2.»DPHDK*DTHnK*SPSDK*CTHDK*SPHDK + 2.*DTHDK*DPSDK*CPSDK* 
JCTHDK*CPHDK - 2.*DPHoK*OPSDK*(CPSOK*STHDK*SPHDK + SPSDK*CPHDK) 
DODD33=-DDPHDK*CTHDK*SPHDK - DDTHDK*STHDK*CPHDK - (DPHDK2 + DTHDK2 
K )*CThOK*CPHOK + 2«*DPHDK*DTHDK*STHDK*SPHDK 
C ********** THE PARTIAL OF D - 1 - DOT WRT PHI DOT 

D0DPD2I =+CPSDK*STHDK*CPHDK - SPSDK*SPHDK 
D0DPD22=-SPSDK*STHDK*CPHDK - CPSDK*SPHDK 
D0DPn23=-CTHDK*CPHDK 

D0DPD31 =+CPSOK*STHDK*SPHDK + SPSDK*CPHDK 
DODPD32=-SPSDK*STHOK*SPHDK + CPSDK*CPHDK 
DODPD33=-CTHDK*SPHDK 

C ********** THE PARTIAL OF D - 1 - DOT WRT THETA DOT 

DODTD1 1 =-CPSDK*STHDK 
DODTDI 2=+SPSDK*STHDK 
DODTD1 3=+CTHDK 
D0DTD21 =+CPSDK*CTHDK*SPHDK 
D0DTn22=-— SPSDK*CTHDK*SPHDK 
DODTD23=+STHDK*SPHDK 
000T031 =-CPSDK*CTHDK*CPHDK 
D0DTD32«+SPSDK*CTHDK*CPHDK 
D0DT033=-STHDK*CPHDK 

C ********** THE PARTIAL OF D - 1 - DOT WRT PS I DOT 

DODSDI 1 »-SPSDK*CTHDK 
OODSD1 2=-CPSDK*CTH0K 

D0DSD21 «-SPSDK*STHDK*SPHOK + CPSDK*CPHDK 
DODSD22=-CPSDK*STHDK*SPHDK - SPSDK*CPHDK 
DODSD31 =+SPSDK*STHDK*CPHDK + CPSDK*SPHDK 
D0DSD32=+CPSDK*STHDK*CPH0K - SPSDK*SPHDK 
c ********************* 

XPRDD= ( DO 1 1 *FXDK+DO 1 2*FYDK+D0I 3*FZDK > *MT I 
YPRDD= (D021*FXDK+D022*FYDK+D023*FZDK)*MTI 
ZPRDD= < 0031 *FXDK+D032*FYDK+D033*FZDK > *MT I 
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C ************* A 1 

A1 X=-MT l*(MASSD*SRSX + MASSC*SRCX + MI*SRtX + 

1 M2*SR2X + m3*SR3X + M4*SR4X ) 

A1 Y=— MT !*<MASSD*SRSY + MASSC*SRCY + M1*SR1Y + 

2 M2*SR2Y + M3*SR3Y + M4*SR4Y> 

A1 Z=-MTI*(MASSD*SRSZ + MASSC*SRCZ + M1*SR1Z + 

3 M2*SR2Z + M3*SR3Z + M4*SR4Z ) 

C ************* A t DOT 

A1DX=-MTI*( MASSC*SRCDX + M1*SR1DX + M2*SR2DX + 

1 M3*SR3DX + M4*SR4DX) 

A 1 DY =— MT I * ( MASSC*SRCDY + Mi*SRtDY + M2*SR2DY + 

2 M3*SR3DY + M4*SR4DY) 

AlDZ=-MTI*( MASSC*SRCDZ + M1*SR1DZ + M2*SR2DZ + 

3 M3*SR3DZ + M4*SR4DZ) 

C ************* A 1 DOUBLE DOT 

A1 DDX 11- MT I* ( MASSC*SRCDDX + M1*SRIDDX + M2*SR2DDX + 

1 M3*SR3DDX + M4»SR4DDX) 

A1DDy=-MTI*( MASSC*SRCDDY + Ml *SR1 DDY + M2*SR2DDY + 

2 M3*SR3DDY + M4*SRaDDY) 

A1DDZ=-MTI*( MASSC*SRCDDZ + M1*SR1DDZ + M2*SR20DZ + 

3 M3*SR3DOZ + M4*SR4DDZ) 

C 

c 

c ********** TORQUE transformation 

c ********* TOTAL TORQUES ON DISK IN EULER COORDINATES 

CSTORX=(TXDK - FYDK*A1Z + FZDK*A 1 Y ) *CPSDK*CTHDK - 

1 (TYDK + FXDK*A1Z - FZDK*A 1 X > *SPSDK*CTHDK + 

2 (TZDK - FXDK*A 1 Y + FYDK*A 1 X > *STHDK 

CSTORY=CPSDK* CTYDK + FXDK*AlZ - FZDK*A1X) + SPSDK* (TXDK - FYDK*A1Z 
1 + F70K*A1Y) 

CSTORZ»FYDK*Al X -FXDKT*A1Y + TZDK 

C *************************************** MASS ACCELERATIONS CALCULATIONS 

200 IFtMASSD .EQ. 0.0) GO TO 201 

RDUMX=SRSX * RDUMYsSRSY * RDUMZ=SRSZ 
RDUMDX=SRSDX * RDUMDY=SRSDY * RDUMDZ=SRSDZ 

RDUMDDX=SRSDDX S R0UMD0y = SRSDDY. $ RDUMDDZ = SRSDDZ 
MDUM=MASSD 

I CK = 2 
GO TO 207 

201 CONTINUE 

202 I F ( M ASSC .EQ. 0.0) GO TO 203 

RDUMX=SRCX * RDUMY=SRCY * RDUMZ=SRCZ 
RDUMOX=SRCDX * RDUMOY=SRCDY S RDUMDZ*SRCDZ 

RDUMDOXbSRCDDX * rdumdoy=srcddy S RDUMDDZ=SRCDDZ 
MOUM=MASSC 

ICK = 0 
GO TO 207 

203 IF(M1 .EQ. 0.0) GO TO 204 

RDUMX=SR1X * RDUMYcSR 1 Y S RDUMZ=SR1Z 
RDUMDX=SR1DX * RDUMDY=SR1DY S. RDUMDZ=SR1DZ 

RDUMDOX=SRl DDX S R0UMDDY=SR1 DDY S RDUMDDZ=SR1 DDZ 
MDUM=M1 
ICK*4 

ADOT l SEsADOT 1 *AD0T1 *PL 
TERX=r-ADOT 1 SE*CA 1 
TERY = -AD0T 1 SE*S A 1 
GO TO 207 

204 IF (M2 .EQ. 0.0) GO TO 205 

RDUMX=SR2X * RDUMY=SR2Y S RDUMZ*SR2Z 
RDUMDX = SR2DX * RDUMDY*SR2DY S RDUMDZ=SR2DZ 

RDUMD0X=SR2DDX * RoUMODY=SR2DDY $ RDUMDDZ=SR2DDZ 
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MDUM=M2 

ick=«; 

AD0T2SE*AD0T2*AD0T2*EL 
TERX=-AOOT2SE*CA2 
TERY=-AOOT2SE*SA2 
GO TO 207 

205 IE<M3 .EG. 0.0) GO TO 206 

RDUMX=SR3X * RDUWY=SR3Y S RDUMZ=SR3Z 
R0UM0X=SR3DX S RDU*DY=SR3DY * RDUMDZ=SR3DZ 
RDUMOOX =SR3DDx S R 0 UMD 0 y=SR 3 D 0 Y * RDUMDOZ»SR3DDZ 
MDUM=M3 
10**6 

AOOT3SE»AOOT3*ADOT3*EL 
TERX=-AD0T3SE*CA3 
TERYs— AD0T3SE*SA3 
GO TO 207 

206 IF (M4 .EO. 0.0) GO TO 200 

RDUMx=SR4X * RDUMY=SR4Y $ RDUMZ=SR4Z 
RDUMDX*SR4DX * RDUMDY=SR4DY S RDUMDZ*SR4DZ 
RDUMD0X=SR4D0x S ROUMD0Y=SR4DDY 8 RDUMDDZ=SR4DDZ 
M0UM=M4 
ICK = 7 

AOOT 4 SE* ADOT 4*AD0T 4*EU 

TERX=-AD0T4SE*CA4 

TERY=-AD0T4SE*SA4 

207 CONTINUE 

ANX*A1X + ROUMX 
ANY*AIY + RDUMY 
ANZ=AIZ + ROUMZ 

PARTlX*D0D01 1*ANX+ D00D12*ANY + D00013*ANZ 
PART 1 Y=DODD2 1 *ANX + DoDD22*ANY + DODD23*ANZ 
PARTlZ>=DOOD31*ANX+ D0DD32*ANY + DODD33*ANZ 

ANDXrAlDX + RDUMDX 
ANOY=A 1 OY + RDUMDY 
ANDZ=A1DZ + RDUMDZ 

PART2X=2.*(DODl 1*ANDX + D0D12*ANDY + D0DI3*ANDZ) 
PART2Y=2.*(OOD21*ANDx + D0D22*ANDY + D0D23*ANDZ> 
PART2Z=2.*(D0D31*ANDx + D0D32 *ANDy + OOD33*ANOZ) 

AND0X=A1DDX + RDUMDDX 
ANDDY C A 1 OOY + ROUMDOY 
ANODZ'AIDDZ + ROUMDO 7 

PART3X=001 l*ANODX + 0012*ANDDY + D013*ANDDZ 
PART3Y=D021*AN0DX + D022*ANDDY + D023*ANDDZ 
PART3Z=D031*ANDDX + D032*ANDDY + D033*ANDDZ 

IF(Ic< .UE. 3) GO TO 210 
ANEWX=A1DDX + TERX 
ANEWY=A1DDY + TERY 

ANEW3X=D01 1*ANEWX + n012*ANEWY + 0013*A100Z 
ANEW3Y = 0021*ANEWX + n022*ANEWY + D023*A100Z 
ANEW3Z=0031*ANEWX + D032*ANEWY + D033*A1DDZ 
ARDOX < I CK ) =PART 1 X + PART0X + ANEW3X 
ARODyI ICK J=PART1 Y + PART2Y + ANEW3Y 
ARODZ ( I CK ) =PART 1 Z + PART2Z +■ ANEW3Z 
210 CONTINUE 
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C **♦*•>** PARTIAL OF Dl DOT WRT PHI DOT * Al VECTOR 
RDDXA= PARTI X + PART2X + PART3X 
RDOY A= PARTI Y + PART 2Y + PART3Y 
RDDZA 3 PARTI Z + PART2Z + PART3Z 
TOTX=MDUfI*RDDXA 

toty=mdum*rddya 

totz=mdum*rddza 

PART4Y=D0DPD21 *RDUMX + DODPD22*RDUMY . + DODPD23*RDUMZ 
PART4Z=»DODPD3!*RDUMX + DODPD32*RDuM Y + D0DPD33*RDUMZ 
PART5X=D0DTD1 1+RDUMX + D0DTD12*RDUMY + DODTDl 3*RDUMZ 
PART5Y=*DODTD21*RDUMX + DODTD22*RDUMY + D0DTD23*RDUMZ 
PART5Z=DODTD3I *RDUMX + D0DTD32*RDUMY + DODTD33*RDUMZ 
PART6X*D0DSD1 1 +RDUMX + DODSD 1 2*RDUM Y 
PART6Y=D0DSD21 *RDUMX + D0DSD22*R0UM Y 
PART 6Z = DODSD3 1 *RDUMX + D0DSD32*RDUMY 
C 

TXX { I CK ) =TOTY*PART4Y + T0TZ*PART4Z 
TYY( ICK )=TOTX*PART5X + T0TY+PART5Y + T0TZ*PART5Z 
TZZ ( I CK ) =TOTX*PART6X + TOTY+PART 6Y + T0TZ*PART6Z 
C 

GO TO (201 .202, 203. 204 *205, 206 *208). ICK 
208 CONTINUE 

C ************************************** TOTAL MASS ACCEL. TERMS 

TX= TXX ( 1 ) +TXX ( 2 ) +TXX(3)+TXX(4 ) +TXX C 5 > +TXX t 6 > +TXX ( 7 > 

TY = TYY ( 1 ) + TYY (2 J+TYY (3 )+TYY (4 ) +TYY ( 5 ) +TYY (6 )+TYY f 7 ) 

TZ=TZZ ( 1 ) + TZZ (2 i + TZZ (3 > + TZZ ( 4 ) +TZZ ( 5 ) +TZZ (6 >+TZZ ( 7 ) 

****** TOTAL INrRTIA MATRIX 

I DXX= I DXXO+ I 1X*CA1*CA1 +1 1 Y*SA 1 *S A I + !2X*CA2*C A2+ 1 2 Y*SA2*SA2 
1+1 3X*CA3*CA3+I3Y*SA3*SA3+14X*CA4*CA4+I4Y*SA4*SA4 
I DYY= IDYYO+I 1X*SA1*SA1+I 1Y*CA1*CA1+I2X*SA2*SA2+I2Y*CA2*CA2 
1 + I 3X*SA3*SA3+ I 3Y*CA3*CA3+ I 4X*SA4*SA4+ I4Y*CA4*CA4 
I DZZs I DZZO+ 1 1 + 12+ 13+ 1 4 

I DXY= I DXYO+ ( I 1 Y-I IX )*SAl*CAl + ( I2Y-I2X)*SA2*CA2 
l+( I3Y-I 3X)*SA3*CA3+ ( I4Y- I4X >*SA4*CA4 
I DXZ= I DXZO * IDYZ^IDYZO 

I DDXX*2 • * < AOOTl *CAI *SA I * ( 1 1 Y- I 1 X J +ADOT2+C A2*SA2* ( 1 2Y- 1 2X ) 

1 +AD0T3*CA3*SA3* ( I 3Y- I 3X ) + AD0T4*CA4*SA4* ( I 4Y- I 4X ) ) 

IDDYY=-IDDXX 

IODXV=ADOTl*(CAl*CAl-SAl*SAl )*< I 1 Y-I1X)+AD0T2*(CA2#CA2-SA2*SA2I* 

1 ( I2Y-I2X)+ADOT3*(CA3*CA3-SA3*SA3 )*( I 3Y- I 3X > +AbOT4* 

1 (CA4+CA4— SA4*SA4 )*< I4Y-I4X) 

****** SOLUTION OF DISK DERIVATIVE EQUATIONS 

YDX=WXDK*C+IDDXX*DU - I DDXY*D2 1 - IDDXZ*D31 ) + 

1 wYDK* < — I DDXY+DI I + ID0YY+D21 - IDDYZ+D31I + 

2 wZDK* ( — IODXZ*Dl I - I DDYZ*D2 I + IDDZZ+D31 ) 

YDY=WXDK*(+IDDXX*D12 - IDDXY+D22 ) + WYDK* (- IDDXY*D 1 2 + IDDYY*D22 >+ 

1 WZDK* ( — I DDXZ+Dl 2 - I DDYZ + D22 ) 

YDZ=WXDK* ( — I DDXZ > + WYDK* ( - I DDYZ ) + WZDK*IDDZZ 

C 

COMPX=+WZDK* ( IDYY*WYOK-IDYZ*WZDK-IDXY*WXDK) -WYDK* { IDZZ*WZDK- IDXZ* 

1 wxdk-idyz*wydk> 

COMPY=+WXDK* ( IDZZ*WZDK-IDXZ*WXDK-IDYZ*WYDK) -WZDK*( idxx*wxok-idxy* 

2 WYDK-IDXZ*WZDK > 

COMPZ = +WYDK* ( I DXX+WXDX- I DXY+WYDK- 1 DXZ+WZDK ) -WXDK* ( I DYY*WYDK - 1 DYZ* 

3 WZDK-IDXY*WXDK) 


62 



APPENDIX B - Continued 


C0A1=+IDXX*D1 t - I DXY*D21 - IDXZ*D31 

COBI te — l DXY*D1 1 + I DYY*02 1 - IDYZ#D31 

COC1 =-IDXZ*Dl 1 - IDY2*D21 + IDZZ*D31 

COA2s+IDXX*012 - IDXY*D22 

COB2=— l DXY*D 1 2 + IDYY*022 

C0C2=— I DXZ*D 1 2 - !DY7*D22 

CO A3=-IDXZ 

COB3=— I DYZ 

COC3a+IOZZ 

C ****** EULER SOLUTION CHECKOUT OPTION 

IFI.NOT. L0ISK40)) CO TO 2 
CO A 1 a I DXX 
COB ls-I DXY 
COC 1 =— I DXZ 
COA2=-IDXY 
COB2= I DYY 
C0C2=— I DYZ 
GO To 3 

2 CONTINUE 

EUL1 =DI2*COMPX 
EUL2=D22*COMPY 

COMPX»CSTORX - TX -YDX + Dll*COMPX + D21*COMPY + D31*COMPZ 

1 -<D1 i*WYDK+D21**XDK )* < I 1 *ADOTl + 1 2* AD0T2+ 1 3*AD0T3+ I 4MAD0T4 1-D31* 

2 ( ADOOT 1 +AODOT2 + ADDOT 3 + ADD0T4 ) 

COMPy=CSTORY - TY -YOY + EUL1 + D22*C0MPY 

1-(D12*WYDK+D22*WXDK>*( I 1 * AOOT1 + 1 2*ADOT2+ I 3*ADOT3+ 1 4*ADOT4 ) 
COMP?=CSTORZ - T7 - YDZ + COMPZ 

1 -D33* ( ADDOT1 +ADD0T2+ ADD0T3+ADD0T4 ) 

3 CONT I NUE 

DET =cOA I * ( C0B24C0C3— COC2*COB3 ) -COB 1 * (C0A2*C0C3-C0A3*C0C2 ) + 

1 C0C1*(C0A2*C0B3-C0A3*C0B2) 

DETI *1 ./DET 

c ********************** CRAMER*S rule ******** 

WXDD<= (COMPX* (COB2*CoC3-COC2*COB3) -COB 1 * f COMPY*COC3-COMPZ*COC2 ) + 
1 COC 1 * ( COMPY*COB3-COWPZ*COB2 ) I *DET I 
WYDDk= ( COA 1 * <COMPY*CoC3-COC2*COMPZ l-COMPX* (COA2*COC3-COA3*COC2 ) + 

1 COCi*(COA2*COMPZ-COA3*COMPY ) )*DETI 
WODDk= ( COA 1 * ( COB2*COMPZ-COMP Y*COB3 > -COB 1 * ( COA2*COMPO-COA3*COMPY )+ 
1 COmPX* (C0A2*C0B3-C0A3*C0B2 ) >*DET I 
WXDHOLD=WXDDK 
WYDHOLD=WYDDK 
WZDHOLD=WZDDK 

c 

c ************ DISK EQUATIONS ******* 

C ************** RUNGE KUTTA INTEGRATION SCHEME ***OM 
IF < .NOT. LDISM17) ) GO TO 301 
GO Tot 161 , 150, 151 .15? 1 , INT 
161 RR 1 1 , 1 3 ) * XPR 
RR ( 1 , 1 4 > * YPR 
RR < 1 , I 5 > a ZPR 
RR ( 1 , 1 6 ) = XPRD 
RR(1 .17) * YPRD 
RR <1 . 1 8 ) = ZPRD 
RR (1 , 19 ) * PHDK 
RR ( 1 .20 > * THDK 
RR( 1 ,21 ) * PSDK 
RR < 1 ,22 ) a WXDK 
RRI1.23) = WYDK 
RR< 1 ,24 > a WZDK 
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APPENDIX B - Continued 



XY = 

0.5 





L = 

2 





I NT 

= 2 




160 

RR (L 

,13) 


XPRD*HH 



RR (L 

,14) 

a 

YPRD*HH 



RR (L 

,15) 

3B 

ZPRO*HH 



RR (L 

. 16 ) 

S 

XPRDO*HH 



RR (L 

.17) 

a 

yprdd*hh 



RR (L 

.18) 

a 

zprdd*hh 



RR (L 

.19) 

2S 

DPHOK*HH 



RR (L 

.20 ) 

a 

dthok*hh 



RR (L 

.21 ) 

a 

DPS0X*HH 



RR (L 

,22 ) 

a 

WX0DK*HH 



RR (L 

.23) 

5= 

WYDDX4HH 



RR (L 

.24 ) 

a 

wzdok*hh 



IF (L 

•E0.5) 

GO TO 153 


154 

RR (6 

.13) 

a 

RR ( 1 ,13)+XY*RR(L 

« 13 ) 


RR ( 6 

, 14 ) 

a 

RR ( 1 « 1 4 ) +XY*RR (L 

• 14 ) 


RR (6 

.15) 

a. 

RR ( 1 , 1 5 ) +XY *RR (L 

.15) 


RR (6 

. 16 ) 

a 

RR ( 1 « 16)+XY*RR(L 

. 16) 


RR (6 

♦ 17) 

a 

RR ( 1 , 17)+ XY *RR ( L 

.17) 


RR (6 

. 18 ) 

a 

RR ( 1 . 18)+XY*RR(L 

. 18 ) 


RR ( 6 

.19) 

a 

RR ( 1 , 1 9 ) +XY*RR (L 

. 19) 


RR (6 

.20 ) 

a 

RR ( 1 , 20 )+xY*RR (L 

,20) 


RR (6 

.21 ) 

a 

RR( 1 .21 )+XY*RR(L 

.21 ) 


RR (6 

,22) 

a 

RR ( 1 ,22)+XY*RR(t_ 

.22) 


RR (6 

.23) 

a 

RR ( 1 . 23 ) +XY*RR (L » 23 ) 


RR ( 6 

,24 ) 

a 

RR ( 1 » 24 )+XY*RR (L 

,24) 


IA = 

L 





GO TO 27 




150 

L * 

3 





INT 

* 3 





GO TO 160 




151 

L * 

4 





INT 

3 4 





XY = 

1.0 





GO TO 160 



152 

L * 






GO TO 160 

153 RR(6.13)=RR(1 
RR (6*14 ) =RR ( 1 
RR ( 6 , t 5 ) =RR ( 1 
RR (6* 16 )*RR ( 1 
RR (6» 1 7 ) =RR (1 
RR(6, 18) =RR ( 1 
RR(6, 19)=RR( 1 
RR ( 6 .20 ) =RR ( 1 
RR ( 6 • 2 1 ) =RR ( 1 
RR (6*22 )*RR ( 1 
RR (6i 23 ) =RR ( 1 
RR ( 6 , 24 ) =RR ( 1 
IA = L 
T = T +HH 

301 CONTINUE 

SUBW=WYDK*WYDK-WXDK*WXDK 

WXWY=WXOK*WYDK 

* ********** CAP R , R-OOT « R-DDOT 

RDDlX=ARODX(4) * RDDlY=ARODY (4 ) 

RDD2X=ARDDX(5) * RDD2Y*ARDDY (5 ) 


1 3 1 + ( RR ( 2 • 1 3 ) +2 ■ *RR ( 3 , 
14) + (RR<2. 1 4 )+2 .*RR ( 3 » 
1 5 ) + ( RR ( 2 , 15) +2 • *RR ( 3 , 

1 6 ) + ( RR ( 2 , 16)+2.*RR(3. 

17) + (RR <2* 17>+2.*RR(3» 
1 8 ) + ( RR <2* 1 8 ) +2»*RR ( 3 ♦ 
1 9 ) + ( RR ( 2 , 1 9 ) + 2 • *RR ( 3 • 
20)+(Rr(2»20 )+2.*RR(3» 

21 ) + ( RR (2,21 >+2.*RR(3. 

22 > + ( RR ( 2 , 22 )+2 • *RR ( 3 » 
23 ) + (RR (2*23) +2» *RR ( 3 , 
24 > + ( RR ( 2 . 24 ) +2 . *RR ( 3 . 


13 ) +2.*RR 

14 ) +2.*RR 

15 ) +2 • *RR 

16 ) +2»*RR 

1 7 ) +2 * *RR 
18>+2.*RR 

19) +2.*RR 

20 ) +2.*RR 

21 ) +2.*RR 

22 ) +2»*RR 

23 ) +2.*RR 

24 ) +2.*RR 


(4.13 

(4.14 

(4.15 

(4.16 

(4.17 

(4.18 

(4.19 

(4.20 

(4.21 

(4.22 

(4.23 

(4.24 


)+RR 
) +RR 
>+RR 
)+RR 
) +RR 
>+RR 
)+RR 
) +RR 
) + RR 
)+RR 
) +RR 
)+RR 


(5. 13) 

(5.14) 
(5*15) 
(5» 16) 
(5*17) 

(5. 18 ) 
(5. 19) 
( 5 * 20 ) 
(5»21 ) 
(5.22 ) 
(5.23 > 
(5.24) 


)*SX 

)*SX 

)*SX 

>*SX 

)*SX 

)*SX 

>*SX 

)*SX 

)*SX 

>*sx 

>*SX 

>*SX 


****** (Dl*Al) 

S RDDl Z=ARDDZ (4 ) 
* RDD2Z=ARDDZ ( 5 ) 
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APPENDIX B - Continued 


RDD3X“ARDDX ( 6 ) S RDD3Y=ARDDY (6 ) S RDD3Z=ARDDZ (6 ) 

RDD4X=ARDDX(7) S R0D4Y=AR0DY (7 ) * RDD4Z= ARDDZ ( 7 ) 


*************************** MASS BALANCE SYSTEM EQUATIONS ** 

!NT=t 

CONTINUE 

IF (LOIS I (19) ) ADDOT1=AODOT2 = AOOOT3 = ADDOT4sO.O 

IF (.NOT. LO I S I (18)) GO TO 77 

AOOOT1=AODHL01 

ADD0t2= ADOHLD2 

AOOOT3= ADOHL03 

ADOOT4= AOOHLD4 

CONTINUE 

CA 1 =COS < A 1 ) S CA2*C0S ( A2 ) * CA3 = C0S(A3) S CA4=C0S(A4) 
SA1=SIN(A1) $ SA2=S IN ( A2 ) * SA3=S!N(A3) $ SA4=S1N(A4) 

I F (EL .EQ. 0.0) GO TO 227 
! F ( M 1 .EG. 0.0 ) GO TO 29 

************************* MBS - MASS 1 ** 

ADOT 1 S= ADOT1 *ADOT 1 
************ SMALL R 
SR 1 X=EL*CA 1 
SR 1 Y=EL*S A 1 
SRI Z=— D I STZ 

************ SMALL R-DOT 
SRI OX=— EL*AOOT 1 *S A 1 
SRI DY=+EL*ADOT l *CA 1 
************ SMALL R-DOUBLE DOT 
SRI DDX = -EL*AOOT 1 S *CA l -EL*ADOOT I *SA I 

SRI DDYa— EL*ADOT 1 S*SA I +EL*ADOOT 1 *CA 1 
************ TERM 2 OF EQ. 4 
AR1DOX=RD01X + XPRDD 
AR1 DOY=RDDl Y + YPROO 
AR1DDZ=RDD1Z + ZPRDO 

F I NA 1 =M 1 * ( -EL*S A 1 * ( DOU *AR 1 DDX+0021 *AR 1 DO Y+D03 1 *AR 1 DDZ > + 

1 EL*CA 1 * ( Dol 2*AR I DDX+D022*ARl D0Y+D032*AR I DOZ I ) 

************ COEFF. OF ALPHA DOUB. DOTS 
FtNNA I =M1 *EL*EL 
I F ( F INNA 1 .EQ. 0.0) GO TO 29 

RIGHrl = ( I IX- II Y)*(SUPW*SA1*CA1 -WXWY* (SA 1 *SA 1 -CA1 *CA1 ) ) 

ADDOT 1 = ( — WZDDK* I 1 - FINA1 - CJ1*AD0T1 + RIGHT1)Z( II + FINNAl) 
CONTINUE 

************************* MBS - MASS 2 ** 

IF(M? .EO. 0.0 ) GO TO 30 

ADOT?S=ADOT2*ADOT2 

SR2XsEL*CA2 

SR2Y»EL*SA2 

SR2Z = DISTZ 

SR2DX«-EL*ADOT2*SA2 

SR2DY=+EL*ADOT2*CA2 

SR2D0X*— EL*ADOTHS*C A js— EL*ADOOT2*S A2 
SR2DDY=-EL*AD0T2S*SA?+EL*ADD0T2*CA2 
AR2DDX=RDD2X + XPRDD 
AR2DOY=RDD2Y + YPRDD 
AR2DDZ=RDD2Z + ZPRDD 

FINA2=M2*(-EL*SA2*(Doi 1 *AR2DDX+D02I *AR2DDY+D03 1 *AR2DDZ ) + 

1 EL*CA2*(DQ1 2*AR2DDX+D022*AR2DDY+D032*AR2DDZ ) ) 


nn n n n on 


APPENDIX B - Continued 


EINNA2=M2*EL*EL 
I E < E I NNA2 .EQ. 0.0) GO TO 30 

R1GHT2* < I2X- I2Y )* (SUBW»SA2*CA2~WXWY* <SA2*SA2-CA2*CA2 > ) 

A000T2= (-WZDDK* 12 - E I NA2 - CJ2*AD0T2 + RIGHT2)/< 12 + EINNA2) 

30 CONTINUE 

************************* MBS - MASS 3 ** 

IE(M3 .EO. 0.0 ) GO TO 31 

AOOT 3S= ADOT 3* A DOT 3 

SR3X=EL*CA3 

SR3Y=EL*SA3 

SR3Z*. -DISTZ 

SR3Z=— D I STZ— 5 • 

SR3Z=-DISTZ*1 .2 

SR30X*-EL*A00T3*SA3 

SR3DY*+EL*AOOT3*CA3 

SR3DOX*-EL*AOOT3S*CA3-EL*ADDOT3*SA3 
SR3DOY = -EL*ADOT3S*SA3 + E:l*ADDOT3*CA3 
AR3DDX=RDD3X+ XPRDO 
AR3DOY = RD03Y+ YPRDO 
AR3DOZ=RDD3Z+ ZPRDD 

E1NA3=M3*(-EL*SA3*(D01 1 *AR3DDX+D02 1 *AR3DDY+D031 *AR3DDZ ) + 

1 EL*CA3*(DOl 2»AR3DDX+D022*AR3DDY+D032*AR3DDZ ) ) 

FINNA3*M3*EL*EL 
I E (E I NN A3 .EO. 0.0) GO TO 31 

RIGHT3* < I3X-I3Y)*<SUBW*SA3*CA3-WXWY*(SA3*SA3-CA3*CA3) ) 

ADD0T3= <-WZDDK*13 - EINA3 - CJ3*AD0T3 + RIGHT3)/( 13 + EINNA3) 

31 CONTINUE 

************************* MBS - MASS 4 ** 

I E ( M4 .EQ. 0.0 ) GO TO 32 

ADOT 4S = ADOT4*A DOT 4 

SR4X=EL*CA4 

SR4Y=EL*SA4 

SR4Z= DISTZ 

SR4Z=DI STZ+5. 

SR4Z=DISTZ*1 • 2 

SR4Dx=-EL*ADOT4*SA4 

SR4Dv«+EL*ADOT4*CA4 

SR4DDX=-EL*ADOT4S*CA4-EL*ADDOT4*SA4 
SR4DDY=-EL*ADOT4S*SA4+EL*AOOOT4*CA4 
AR4D0X=RD04X + XPRDD 
AR40DY=RD04Y + YPRDD 
AR4DDZ=RDD4Z + ZPRDD 

El NA4 = M4* <-EL*SA4* (DOl 1 *AR4 DDX+D02 1 * AR4DDY+D03 1 *AR4DDZ ) + 

1 EL*CA4* (D01 2*AR4DDX+D022*AR4DDY+D032*AR4DDZ ) ) 

EINNA4»M4*EL*EL 
I E ( E I NNA4 .EQ. 0,0) GO TO 32 

RtGHT4<* < I4X- I4Y)* <SUBW*SA4*CA4-WXWY* CSA4*SA4-CA4*C A4 ) ) 

AOOOTA * ( — WZDDK* 1 4 - E I NA4 - CJ4*AD0T4 + RIGHT4)/( 14 + FINNA4) 

32 CONTINUE 

IE (LD I S I (33) ) ADDOT 1 = ADD0T2= ADDOT 3= ADD0T4= ADOT 1 =AD0T2=AD0T3=AD0T4=0 

ADDHlDI =AD00T1 

ADOHLD2=ADDOT2 

ADOH(_03 = AD00T3 

ADDHl_D4 » ADDOT 4 

*********************INTEGRATION SCHEME FOR MASS BALANCING SYSTEM 
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c 


c 

c 


1 21 


120 


114 


1 1 0 


1 1 1 


1 12 
113 


227 


IF (Ml .EQ.0.0.AND.M2.FQ.0.0.AND.M3.EQ.0.0.AND.M4.EG.0’.0 ) GO TO 227 


IF f .NOT. LOIS! ( 17 )) GO TO 227 


GO TO 

(121.110,111,112), 

INT 


RR(1 , 

1 )=A1 



RR(1 , 

2 ) =A2 



RR ( 1 , 

3 ) = A3 



RR U i 

4 )=A4 



RR ( 1 • 

5 ) = AOOT 1 



RR ( 1 « 

6 >=AD0T2 



RR ( 1 , 

7 ) » ADOT 3 



RR ( 1 , 

8 )=AD0T4 



XY = 

L = 2 

0.5 



INT = 

2 



RR(L, 

1 ) 3 ADOT 1 *HH 



RR (L . 

2 )=A00T2*HH 



RR (L « 

3 )=AD0T3*HH 



RR(L, 

4 )=ADOT4*HH 



RR(L. 

5 )=ADDOT 1 *HH 



RR <L . 

6 )=ADDOT2*HH 



RR <L . 

7 ) = ADDOT 3*HH 



RR <L ♦ 

8 ) = ADDOT 4*HH 



I F (L .1 

EQ .5 ) GO TO 113 



RR (6 . 

1 ) = RR ( 1 . 1 >+XY*RR(L. 

1 > 

RR (6. 

2) = RR ( 1 , 2)+XY*RR(L, 

2 ) 

RR ( 6 . 

3) = RR ( 1 , 3)+XY*RR(L. 

3 ) 

RR (6, 

4) s RR(1. 4)+XY*RR(L, 

4 ) 

RR (6i 

5) = RR ( 1 , 5)+XY*RR(L. 

5) 

RR<6, 

6) st RR(l, 6 )+XY*RR (L , 

6 > 

RR (6. 

7) s= RR ( 1 , 7 )+XY#-RR (L , 

7) 

RR (6, 

8) = RR ( 1 , 8)+xY*RR(L, 

8 ) 

IA = 1 

L 



GO TO 
L = 3 

28 



INT st 

3 



GO TO 
L * 4 

120 



INT = 

4 



XY = 

1.0 



GO TO 
L * m 

1 20 



GO TO 

1 20 



RR (6. 

1 )=RR( 1 , 1 )+(RR<2. 

1 ) +2 

. *RR ( 3 , 

RR (6. 

2 ) =RR < 1 , 2 ) + ( RR < 2 , 

2 ) +2 

• *RR ( 3 , 

RR (6, 

3 ) =RR ( 1 , 3 ) + ( RR ( 2 , 

3 ) +2 

. *RR ( 3 , 

RR (6. 

4 ) =RR ( 1 , 4 ) + ( RR ( 2 , 

4 ) +2 

. *RR ( 3 . 

RR (6. 

5 ) *=RR ( 1 , 5 ) + ( RR ( 2 , 

5 ) + 2 

. *RR ( 3 , 

RR (6. 

6 ) =RR ( 1 » 6 ) + ( RR ( 2 , 

6 ) +2 

• *RR ( 3 , 

RR (6 . 

7 ) =RR ( 1 , 7 ) + ( RR ( 2 , 

7 ) +2 

. *RR ( 3 , 

RR (6. 

8 ) =RR ( 1 . 8 ) + ( RR ( 2 , 

8 ) +2 

. *RR ( 3 , 


r A = L 
CONTINUE 


1 )+2.*RR<4. 1 )+RR(5» 1 ) )*SX 
2>+2.*RR(4, 2 ) +RR ( 5 « 2>)*SX 
3 ) + 2 » *RR ( 4 » 3 ) +RR ( 5 * 3))*SX 

4 ) +2 . *RR ( 4 ♦ 4 ) +RR ( 5 » 4))*SX 

5 ) +2 » *RR ( 4 « 5 ) +RR ( 5 . 5>)*SX 

6 > +2 • *RR ( 4 , 6 ) +RR ( 5 , 6 ))*SX 

7 ) +2 » *RR ( 4 * 7 ) +RR ( 5 * 7>)*SX 

8 ) +2 » *RR ( 4 » 8)+RR(5, 8>)*SX 


****** TIC MARKS FOR ACTUAL PROGRAM TIME 

LOT SO (31 ) *LD I SO < 1 03)st.F. 

IF (T .EQ. 0.0) LDIS0(31 )=LDt SO ( 103)=»T. 
IF((T-TSAVE) .UT. TIMER) GO TO 90 
LO I SO <31 )=LD!SO U 03 ) = .T. 

TSAVE=T 
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APPENDIX B - Continued 


90 CONTINUE 


****** AUXlLLIAPY CALCULATIONS 

CMO=SQRT(AlX*AlX+Al Y*A 1 Y ) 

I XCG= IOXX+MASSD* < < A 1 Y+SR SY ) * ( A1 Y+SRSY >+ ( A1 Z+SRSZ ) * ( A 1 Z+SRSZ ) t 
1 +MASSC* < (Al Y+SRCY )* ( Al Y+SRCY ) + < A 1 Z+SRCZ >* ( A1 Z+SRCZ ) ) 

2+M1 * ( < Al Y+SRl Y)*( A 1 Y+SRl Y) + (AlZ+SRlZ)*(Al Z+SRl Z ) ) 

3+M2*( ( Al Y+SR2Y )*( At Y+SR2Y 1+ ( A 1 Z + SR2Z >*( A 1 Z+SR2Z ) ) 

4+M3*( ( A1Y+SR3Y)*(A1 Y+SR3Y)+( A 1 Z + SR3Z ) * ( A 1 Z+SR3Z ) ) 

5+M4*( ( Al Y+SR4Y )*( Al Y+SR4Y )+ ( A1Z+SR4Z )* ( Al Z+SR4Z ) } 

1 YCGtt l DYY+MA SSD* ( ( Al x+SRSX )* ( A 1 X + SRSX >+( A 1 Z + SRSZ ) * ( Al Z+SRSZ ) ) 

1 +MASSC* ( ( A 1 X+SRCX )* ( Al X+SRCX ) + ( A 1 Z+SRCZ ) * ( A 1 Z + SRCZ ) ) 

2+M1* ( ( A 1X+SR1X )* ( A 1 x+SRl X ) + ( Al Z + SR1Z >* ( A 1 Z+SRl Z ) ) 

3+M2* ( ( A1X+SR2X )*( A 1 X+SR2X ) + ( A 1 Z + SR2Z >* ( A 1 Z+SR2Z ) ) 

4+M3*( (Al X+SR3X ) * ( A 1 X+SR3X )+ ( A 1 Z + SR3Z >*( A 1 Z+SR3Z ) > 

S+M4*( (A1X+SR4X)*(A1X+SR4X)+(A1Z+SR4Z >*(A1Z+SR4Z) ) 

I ZCG= 1 DZZ+MASSD* ( (Al X+SRSX )* (Al X + SRSX 1+ ( A 1 Y + SRSY )*( Al Y+SRSY ) ) 

1 +MASSC* ( (Al X+SRCX 1* ( Al X+SRCX )+ ( A 1 Y + SRCY ) *( Al Y+SRCY ) ) 

2+M 1 * ( ( A 1 X+SRl X )* ( Al X + SRl X )+ ( Al Y + SRl Y )* ( A 1 Y+SR1 Y ) ) 

3+M2* ( ( A 1 X+SR2X ) * ( A 1 X + SR2X ) + ( A 1 Y + SR2 Y ) * ( A 1 Y+SR2Y ) ) 

4+M3* ( ( Al X+SR3X )* ( Al X+SR3X ) + ( A 1 Y + SR3 Y )* ( Al Y+SR3Y ) ) 

5+«4*( ( A1X+SR4X )*(Al X+SR4X1+ ( At Y+SR4Y >*( Al Y+SR4Y) ) 

IXYCG= 1 DXY+MASSD* ( ( A 1 X + SRSX )*( A 1 Y + SRSY ) ) 

1 +MASSC* ( ( A 1 X+SRCX ) * ( A 1 Y+SRCY) ) 

2+M 1 + ( ( A1X+SR1X )*(A1 Y+SRlY) )+M2*( ( A 1 X+SR2X ) * ( A 1 Y+SR2Y ) ) 

3+M3* ( ( A 1 X+SR3X )* ( A l Y+SR3Y ) ) + M4* ( ( A 1 X + SR4 X ) + ( A 1 Y+SR4Y ) ) 

I XZCG* I DXZ+MASSD* ( ( A 1 X+SRSX ) * ( A 1 Z+SRSZ > > 

1 +MASSC* ( { A i X + SRCX ) * t Al Z + SRCZ ) ) 

2 + M 1 * ( ( Al X+SRl X)*(Al Z+SRl Z) )+M2*( ( A 1 X+SR2X ) * ( A 1 Z+SR2Z ) ) 

3+M3+ ( ( Aix+SR3X)*(AiZ+SR3Z) )+M4*( ( A 1 X+SR4X ) * ( A 1 Z+SR4Z > ) 

IYZCG=IDYZ+MASSD*( (Aiy+SRSY)*(A1Z+SRSZ) ) 

1 +MASSC* ( (Al Y+SRCY )* (Al Z+SRCZ) ) 

2+M 1 * ( ( Al Y+SR 1Y)*(A1 Z+SRl Z) ) + M<;*( ( A , Y+SR..Y > * ( « Z-. SR Z> ) 

3 + M3* ( ( A 1 Y+SR3Y ) * ( A 1 Z+SR3Z ) > + M4*< ( A 1 Y + SR4 Y ) * ( A 1 Z+SR4Z > ) 

I MAT ( 1 « 1 ) = I XCG $ Im.AT( 1 .2 )=-I XYCG * I MAT ( 1 , 3 ) «- I XZCG 
IMAT { 2 « 1 ) = — I XYCG * !MAT(2,2)= IYCG * I MAT ( 2 , 3 ) =- I YZCG 
IMAT ( 3 . 1 ) = -I XZCG S I MAT (3.2)= -1YZCG $ !MAT(3.3)= IZCG 
CALL JACTV (3*3.1 . l MAT . E I GV . E VEC . B , C . W 1 .W2.NERR i 
IF(NFRR .EQ. 1 ) PR TNT 100 

100 FORMAT ( 10X+NON CONVERGENCE AFTER 100 ITERATIONS*) 

ETAXZ*. 15514022 S ETAYZ=. 1 5514022 

IF (EvEC (3.3) .NE. 0.0) ETAXZ = AT AN2 ( EVEC ( 1 . 3 > « E VEC ( 3 . 3 ) ) 

I F ( EvEC (3*3) .NE. 0 . 0 ) ETAYZ=ATAN2 (EVEC ( 2 . 3 ) .EVEC ( 3 .3 > ) 

ETAXYZ* SORT ( ETAXZ *ET AXZ+ ETA YZ*ETA YZ ) 

DELE = . 15514022 

IFtETAXZ.NE. 0.0) DElE=ATAN2 (ETAYZ. ETAXZ ) 

T I AD= I 1 *AD0T 1 + 1 2 + AD0T2+ I 3* AD0T3+ 1 4 * A00T4 
A I WX= I XCG+WXDK- I XYCG*WYDK- I XZCG+WZDK 
1 - ( A 1 x+SR 1 X ) * ( A 1 Z+SRl Z ) *AD0T 1 *M1 - ( A 1 X+SR2X ) * ( A 1 Z+SR2Z ) *AD0T2*M2 
1 — (Alx+SR3X)*(Al Z + SR37 ) *AD0T3*M3— ( A 1 X+SR4X )*(A1Z+SR4Z) *A00T4*M4 
A I WY = — l XYCG+WXDK+ I YCG*WYDK- I YZCG*WZDK 
1 - ( Al y+SRI Y )* ( A 1 Z+SRl Z ) *AD0T 1 *M 1 — ( A 1 Y+SR2Y ) * ( A 1 Z+SR2Z ) *AD0T2*M2 
1 - ( Al Y+SR3Y )*( A 1 Z + SR3Z )*AD0T3*M3— ( A J Y+SR4 Y ) * ( A 1 Z+SR4Z ) *AD0T4*M4 
A I WZ = - I XZCG+WXDK- I YZcG*WYDK+ I ZCG+WZDK 
1 + ( ( Al X+SRl X )* ( Al X + SRlX )+ ( A 1 Y + SRl Y ) * ( A 1 Y+SRl Y ) )*AD0T1*M1 
1 + ( ( A i X+SR2X )* ( A1X+SR2X )+ ( Al Y + SR2Y ) + ( A 1 Y+SR2Y > )*AD0T2*M2 
1 + < ( A 1 X+SR3X ) * ( A 1 X + SR3X )+ ( A 1 Y + SR3Y ) * ( A 1 Y+SR3Y ) )*AD0T3*M3 
l + ( ( A l X+SR4X )* ( A 1 X+SR4X )+ ( A 1 Y+SR4 Y ) * ( A 1 Y+SR4 Y > >*ADOT4*M4+ T I AO 
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APPENDIX B — Continued 


A I WX2- A I WX*A ! WX 
AIWY?=AIWY*AI WY 
A SOP = SORT (A I WX2 + A I WY? ) 

THETH=. 15*514022 

IF ( A 1 WZ .NE. 0. )THETH=ATAN2(ASQR.AIWZ) 

DELH=. 15514022 

IF(WXDK «NE. 0.0 >DELH = ATAN2 ( A1 WY , A 1 WX > 

THETZ=SQRT (PHDK*PHDK + THDK*THDK ) 

DELZ=. 15514022 

IF(PHOK.N£.0.0)DELZ=ATAN2(THDK«PHDK )+l .570795 
0 1 WX=WXDK*WXDK 
BIWY=WYDK#WYDK 
BSORsSQRT t.BI WX+B! WY 1 

THETJ = . 15514022 

1FCW2DK .NE. 0)THFTI=ATAN2(BS0R.WZDK) 

DELI=. 15514022 

IF (WxDK.NE. 0.0 )OELl * ATAN2 ( WYDK . WXDK > 

CONSQ=THETH*THETH + ETAXYZ*ETAXYZ - 2.*THETH*ETAXYZ*COS (DELH-DELE) 
CON*57.295780*SQRT(CONSQ> 

DEL£=DELE *57.295780 
ETAXZ=ET AXZ *57.295780 
ETAY7=ETAYZ *57.295780 
ETAXYZ=ETAXYZ*57. 295780 
THET H x 57.29578*THETH 
DELH=57. 29578 *0ELH 
THET2=57.29578*THETZ 
DELZ =57 . 29578 *DEl_ Z 
THET 1 =57.29578*THET I 
DELI =57.29578* DELI 
A 1 A=57.29578*A1 
A2A=F7.29578*A2 
A3A = 57 . 29578* A 3 
A4A=F7.29578*A4 

****** RECORDER CHANNEL OUTPUTS 

D1G0UT( l)=CMO*SFCMO 
D 1 GOUT C 2 ) a A 1 X*SFA 1 X 
DIGOuTf 3>=A!Y*SFA1Y 
DIGOUT ( 4 )=ETAXY2*SFPTA 
D I GOIJT ( 5 ) =ET AxZ *SF=TAX 
DIGOUTC 6 ) =ET A YZ *SFFTAY 
DIGOUT ( 7 )=THETZ*SFThETZ 
DIGOUT ( 8)»C0N*SFC0N 
01 GOUT ( 9 ) =THETH*SFTH 
D I GOUT ( 10 ) =THET I *SFT I 
O I GOUT (11 )=ADDOTl*SFACC 
DIGOUT( 121=0.0 
D I GOUT (13) =A 1 A*SFMB A 
DIGOUT ( 14 ) =A2A*SFMB A 
DIGOUT( 15)=A3A*SFMBA 
DIGOUTt 16)=A4A*SFMBA 
C *** SCANNER FUNCTION********** 

90047 LDISO( 124)=LD!SI (22) 

C***» COMMUNICATION WITH RFAL TIME DISPLAY 
IF (LD! S I (22 ) ) CALL SCANNFR ( I SC AN ) 

CALL DSPLAY 

IF (LDI S I ( 1 7 ) ) GO TO 90050 
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C**»* RETURN TO MODE CONTROL SUBROUTINE 
LD!S0(59)=.F. 

LDIS0<60 )=.F. 

LD I SO ( 1 02 ) = .F. 

LD I So ( 1 10 ) = .F. 

C 

90 050 CONTINUE 

C 

C ****** REAL TIME CRT PLUI t KM vs im - 1 iv UfcUKtts ) 

THDEG=THDK*57. 295780 
PHDE0sPH0k:*57. 295780 

IFITHOEG .EQ. 0. .ANO.PHDEG .EQ. 0.) GO TO 50002 
IF< .NOT. LD I S I ( 41 ) ) GO TO 50002 
CALL R I TECRT (LD I S I (17)».T,»10) 

50002 CONTINUE 

CALL RTMODE 

C***» RETURN FROM MODE CONTROL INTO OPERATE LOOP 
90001 CONTINUE 

LDISO(59)=.T. 

LDISO(60)=.T. 

LDISOC102)=.T. 

LDISnt 1 10)=. T. 

IZZ = . F . 

CALL RECORD 
CALL RECYCLE 
GO TO 90006 

C**** SECTION H. PRINT CONTROL 
90014 CONTINUE 

NUMBFR= ( NUMBER-*- 1 ) 

WR 1 TE ( MF , 89 ) NUMBER 
89 FORMAT ( 1 HO. 1 2HRUN NUMBER =.2X.I5> 

WRITE (MF, l 30 ) HH, (VAR( I ) . 1=1 *38) 

130 FORMAT ( 5X*HH = *E 12.4. lOX*VAR BLOCK. (1 ThRu 30 » */ * 1 OE I 3 . i> > ) 

WRITEfMF. 132 >RFX.TXD«.MASSD. IDXYO.SRSX.SRCX.RF Y.T YDK.MASSD. 

1 IDXZO.SRSY.SRCY.RFZ.TZDK.MASSC. IDYZO.SRSZ .SRCZ.FXDK.FYDK.FZDK 

1 32 FORMAT <///2X*RFX = *El 2.5, 2X*TXDK = *E 12 .5.2 X*MASSD=*E 12.5. 

A 9X* IDXY0=*El 2.4 , 2X*RSX=*E 12 .4 ,2X*RCX=*E 12.4/ 

1 2X*RFY=*E1 ?.5.2X*TYDK=*E 12 .5 . 2X*MASSD=*E 12.5. 

B 9X* IDXZ0=*E1 2.4 ,2X*RSY=*E 12.4. 2X*RCY=*E1 2.4/ 

2 2X*REZ=*E12«5.2X*TZDK=*E12 .5 . 2X*MASSC= *E 12.5. 

C 9X*IDYZ0 = *El2.4 ,2X*RSZ=*EI2 . 4 . 2X*RCZ = *E 1 2.4// 

D 2X*FXDK=*E12«4.2X*FYDK=*E!2 .4 ,2X*FZDK=*E1 2.4 ) 

WR ITEIMF, 133 ) I 1X.I2X. I3X. I 4 X « I 1Y.I2Y.I3Y.I4Y 

133 FORMAT (2X* I 1 X = *E 1 2 . 5 ,2 X* I 2X = *E 1 2 . 5 , 3 X** I 3X = *E 1 2 .5 , 4X* I 4X = *E 1 2 . 5/ 

1 2X* I 1 Y=*E12.5,2X*I2y=*E1 2.5.3X* I 3Y = *E 1 2 . 5 , 4X* I 4 Y = *E 1 2 . 5/// > 

WRITFIMF, 1 31 ) 

1 31 FORMAT ( 26X*T I ME*44X*sRCX* 1 2X*SRCY* 1 2X*SRCZ*/ 

1 26X*WXDK*1 2X*WYDK*1 2X*WZDK* 1 2X*PHD<* 1 2X*THDK*1 2X*PSDK*/ 

1 26X*WXDDK*1 I X*WYDD<*I 1 X*WZDDK*1 1 X*41 X*1 3X*A] Y*I 3X*A 1 Z*/ 

1 26X*Al*14X*A2*l 4X*A3*1 4X*A4*1 4X*ETAY*12X*ETAX*/ 

1 26X* ADOT 1 * 1 1 X*AD0T2*1 1 X*ADOT3*l 1 X*AD0T4*1 1 X*CM0*/ 

1 26X*ADD0T 1*1 Ox* ADD0T2* 1 OX*ADDOT3* 1 OX*ADDOT4* 1 0X*ET A* 1 3X*DEL 

2TA*/?6X*THETH*1 1X*DELH*12X*THETZ*1 1 X*DtLZ* 1 2X*THET I* 1 1 X*DEL X */// ; 
90030 CALL PL A YBAK < 90032S » NF I LE ) 

WR ITE (MF , 1 800 ) T. SRCX , SRC Y . SRCZ 

WRITE(MF,180l ) WXDK , WYDK . WZDK . PHDK , THDK , PSD< 

WR I TE ( MF , 1 80 1 ) WXDDK , WYDDK , WZDDK .AlX.AlY.AlZ 
WRITEfMF, 1801 ) A 1 A . A2 A , A3A , A4 A , ET AXZ . ET A YZ 
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WR I TE ( MF , 1801 ) A00T1 « A DOT 2 « AD0T3 * ADOT 4 « DELE » ET AXV2 

WRITE ( MF , 1 80 1 ) ADOOT1 . ADD0T2 . ADD0T3 , ADD0T4 . CMO.CON 
WR !TF< MF, 1 801 ) THETH , pELH , THETZ . DELZ . THET 1 .DEL I 
WRITE (ME. 180 I ) E I GV ( 1 ) , E IGV ( 2 ) . E f G v < 3 > 

1 800 FORMAT (/23XE1 2.5. 32X, 3 ( 4XE1 2.5 > ) 

1801 PC-MAT! 19X.6(4XE12.5) ) 

GO TO 90030 

90032 CALL APRINT 

C**** SECTION I. READ CONTROL 

90015 CONTINUE 

C**»* ANY READ STATEMENTS CAN BE PLACED HERE TO INITIALIZE FOR A NEW RUN 
C*** READ **.A,B,C 
C ** FORMAT (8E16.8) 

CALL AREAO 

C**»* SECTION J. TERMINATE 
90004 CONTINUE 
C**** ANY POST PROCESSING 
CALL ATERM 

90034 FORmaT(6X* SPACE BASE S 1 MUL AT I ON*5X* JOB . 4 3 , 7T777 ♦ 75000 . A2718. 

1 1 3043, 1 .C.W.MARTZ.Bl 232 R125*) 

END 


71 


APPENDIX C 


TRANSFORMATION MATRICES AND DERIVATIVES 


The following transfer matrices and derivatives, collected for convenience, are 
used in the simulation. For identification or explanations, see section of appendix A 
entitled "Transfer Matrices." 



ci// c £? 

-Si// C0 

sd 

Cl// St? S (/> + si// c</> 

ci// C 0 - si// St? S0 

-c8 s 0 

si// S</> - Cl// St? c<p 

Cl// S0 + si// S0 c<p 

Ct? c <p 



is the same as 



with subscript h on angles. 



ci// c 6 
-si// c 6 
s B 


si// 0 

ci// 0 

0 1 


- -1 


~ *“ 

D h 

is the same as 

D 


with subscript h on angles. 



ca?j -soij 0 

SO! j CO! j 0 

0 0 1 



-i// si// c6 - 6 ci// s 6 
-i// ci// c6 + 8 si// s# 
6 c 6 


i// ci// 0 

-i// si// 0 

0 0, 



is the same as 



with subscript 


h 


on angles. 


r~ n 


" d il 

d 12 

~I 

d 13 

•Q 

= 

d 21 

d 22 

d 23 



d 31 

d 32 

d 33 
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APPENDIX C - Continued 

where 

d'n = -d cp sd - ip sip cd 
d'12 = d sip sd - ip cip cd 
dj 3 = 6 cd 

dgi = ip(cp sd c 0 - sip s cp) + 6 cip cd s<p - ip{s\p sd s ep - cip cp) 
d^ = -<J)(s ip sd cc b + cip s<p) - 6 sip c6 scp - p(cp sd sp + sip cep) 
^23 = ~4> C( P + 9 s0 S( P 

t • • • 

d^j = p(cp sd scp + sip c <p) - d cip cd cep + ip(sip sd cep + cp scp) 
d^ = -<p(sip sd scp - cip cep) + d sip cd cep + ip{cip sd cep - sip sep) 

d 33 = ~<t> ce S< P ~ Q s0 CC P 



is the same as 



with h subscripted angles and angular rates. 



where 

dji = - 0 " cip sd - ip" sip cd + 2 dip sip sd - + ipZ)cip cd 

djg = 0" SI P s0 ~ *P" Cx P c0 + (0 2 + ip^)sip cd + 2i^0 cip sd 
dj 3 = 0" cd - d 2 sd 

dgi = ep"( cip sd cep - sip sep) + 0" cip cd sep - ip"(sip sd sep - cip cep) - ( ip 2 + ip 2 ){cip sd sep 
+ sp cep) - d 2 cip sd scp + 2 pd cip cd cep - 2 dp sp cd scp - 2pcp(sp sd cep + cp sep) 
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= -0 n (s0 s 9 c0 + c0 s0) - 0" s0 c 9 s 0 - 0"(ci // s0 s0 + si// c0) + (</>2 + 02)(s0 s9 s0 
- ci// c</>) + 02 si// s 9 s </> - 200 si// c0 c0 - 200 ci// c0 S0 - 200(c0 s0 c0 - si// s0) 


^23 = “ 0" c0 c0 + 0" S0 s0 + (02 + 02) C 0 S 0 + 200 s0 c0 

dgi = 0"(c0 S0 S 0 + Si// C0) - 0" C 0 C0 C 0 + i//"( S0 S0 C 0 + C 0 S0) + ((/>2 + 0/2)(c0 gg C 0 
- S0 S0) + 02 C0 S0 C 0 + 200 Cl// C0-S0 - 200(S0 S0 S 0 - Cl// C 0) + 200 S0 C0 C0 

^32 = - 0 T ’(si0/ S0 S0 - C0 C 0) + 0" S0 C0 C 0 + 0"(c0 S0 C0 - S0 S 0) - (02 + 02)(s0 S0 C0 
+ C0 S0) - 0^ S0 S0 C 0 - 200 S0 C0 S 0 + 200 C 0 C0 C 0 - 200(c0 S0 S0 + S0 C 0) 


^33 = S< ^ " C( t ) ~ + c< £ + 20$ s< £ 






C0 

-S0 




C 0 

c 0 


D 

-1 _ 

S0 

C0 




-C0 S0 

S0 S0 




C0 

c 0 

is the 

same 

as [dT 1 

with 


0 

0 

1 


h subscripted angles. 


Dl 

-1 

Dl 

r i 

-1 

r- — 

p 2 


d 2 

L _ 

f '*■ 

-1 

L- — 

p3 


03 


T 

T 

T 



-c0 s0 0 0 

s0 s0 0 0 

c0 0 0 


~ 9 D h ~ 

is the same as 

9D 


* Q? 
Qb 

^r 

i 


80 


with h 


subscripted angles. 
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3D ] _ 
_ 9 0_ 


-si // c 0 ci p 0 

= -ci// c 0 -si p 0 


3Dv, 8D 

is the same as — with h subscripted angles. 

3^ h a* 


30 30 h 


-ci// se 


Sl// S0 


= ci// c 0 S 0 -S 0 c 0 S 0 S0 S 0 
-Cl// C0 C 0 Sl// C0 C0 -S0 C0 


is the same as with h subscripted angles. 

30 h 30 


-S0 C0 


-C 0 C0 


= -S0 S0 S 0 + ci// C0 -Cl// S0 S 0 - Sl// C0 
S0 S0 C 0 + Cl// S 0 C0 S0 C 0 - Si// S0 


3D 2 SDj 

— - is the same as with h subscripted angles. 

30U 3i// 


= — = C0 S0 C 0 - S 0 S 0 -Sl// S0 C 0 - Cl// S0 -C0 C0 

30 30 

C10 S0 S 0 + Sl// C 0 -Sl// S0 S0 + C0 C 0 -C0 S0 


is the same as 


with h subscripted angles. 
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o o o 


V3 Ci 

•5 ‘t 
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TABLE I.- PHYSICAL CONSTANTS USED IN BASIC COMPUTER SIMULATION 


Constants: 

m d = 350 000 kg 
m c = 1500 kg 

mj = m 2 = m3 = 1TI4 = 3200 kg 

■d,x = Id,y = 3 ' 8 X 108 te-” 2 
! d)Z = 1.9 x 10 8 kg-m 2 

ld,xy = ld,xz = ld,yz = 8 

lc,x = lc,y = *c,z = Ic.xy = *c,xz = Ic.yz = 0 

Ij ’ x = 7 10 km 2 0 = 1,2, 3, 4) 

I j ’ y = I j z = 7800 kg-m 2 (j = 1) 2, 3, 4) 

(i - 15 m 


hi = -7.5 m ^ 

h 2 = 7.5 m l (Note the separate 
h3 = -9 m ( z-axis for coll 
114 = 9 m -J 

Ci = C 2 = C3 = C4 = 4000 N-m-s 


(Note the separation of controllers along the 
z-axis for collision avoidance purposes) 


Initial conditions: 

w x = ^y = 0 

<x> z = 0.5 rad/s 
ffp« 2 = 1.57080 rad 
“3 - Q, 4 = -1-57080 rad 
«1 = «2 = "3 = “4 = 0 
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TABLE II.- KEYBOARD INPUT VARIABLES 


Variable (VAR) Variable name 


1 

PHDK0 

2 

THDK0 

3 

PSDK0 

4 

WXDK0 

5 

WYDK0 

6 

WZDK0 

7 

XPR0 

8 

YPR0 

9 

ZPR0 

10 

XPRD0 

11 

YPRD0 

12 

ZPRD0 

13 

IDXX0 

14 

IDYY0 

15 

EDZZ0 

16 

A 10 

17 

A20 

18 

A30 

19 

A40 

20 

110 

21 

120 

22 

130 

23 

140 

24 

M10 

25 

M20 

26 

M30 

27 

M40 

28 

EL 

29 

DISTZ 

30 

CJ0 






J 

-\ 

J 

> 

s 


Symbol or Description 


0 O) 6 0 , and 0 O 


Initial value of 

x o> y ' 0 > and z o 

yo> and z o 


Initial disk inertias about x-, y-, and 
z-axes 


Initial values of aj 


Initial controller inertias about z-axis 


Initial values of mj 


j e 

h 

Initial damping coefficient for jth controller 
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TABLE IL- KEYBOARD INPUT VARIABLES - Concluded 


Variable (VAR) 
31 

Variable name Symbol or Description 

SRCDXQ^ r ^ 

32 

33 

SRCDY0 

SRCDZQ^ 

Initial value of j r c j 

34 

FREQ 

CRT real-time plotting frequency (number 
of iterations per plot point) 

35 

36 

P LG AIN 

CRT plot x- and y-axis gain (units of x 
and y, full scale) 

37 

MASSD0 

Disk mass 

38 

MASSC0 

Crew mass 
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TABLE m.- TIME-HISTORY RECORDER OUTPUT 


Recorder channel 

Symbol 

Parameter 

Scale factor 

Range 

1 

Rx + A l,y 

CMO 

SFCMO 

0 to 0.1 m 

2 

A l,x 

A1X 

SFA1X 

±0.1 m 

3 

A i,y 

A1Y 

SFA1Y 

±0.1 m 

4 

V 

ETA 

SFETA 

0 to 0.1° 

5 


ETAX 

SFETAX 

o 

H 

o 

+i 

6 

v y 

ETAY 

SFETAY 

o 

t-H 

o 

M 

7 

8 

Qz 

THETZ 

SFTHETZ 

0 to 0.2° 





9 


THETH 

SFTH 

0 to 0.2° 

10 

e i 

THETI 

SFTI 

0 to 0.2° 

11 

12 

“l 

ADDOT1 

SFACC 

±0.001 rad/sec^ 





13 

a i 

A1A 

SFMBA 

o 

O 

00 

t-H 

-H 

14 

«2 

A2A 

SFMBA 

±180° 

15 

“3 

A3 A 

SFMBA 

±180° 

16 

a 4 

A4A 

SFMBA 

±180° 
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TABLE IV.- PROGRAM SYMBOL LISTING 


[An asterisk denotes printed output] 


FORTRAN notation 


Symbol definition 


*T 

*PHDK, THDK, PSDK 
*WXDK, WYDK, WZDK 
*WXDDK, WYDDK, WZDDK 
SRX, SRY, SRZ 
SRSX, SRSY, SRSZ 
*SRCX, SRCY, SRCZ 

SR IX, SR1Y, SRIZ^ 

SR2X, SR2Y, SR2Z l 
SR3X, SR3Y, SR3Z [ 

SR4X, SR4Y, SR4Z ^ 


SRDX, SRDY, SRDZ 
SRSDX, SRSDY, SRSDZ 
SRCDX, SRCDY , SRCDZ 


SR1DX, SR1DY, SR1DZ 
SR2DX, SR2DY, SR2DZ 
SR3DX, SR3DY, SR3DZ 
SR4DX, SR4DY, SR4DZ^ 




SRSDDX, SRSDDY, SRSDDZ 
SRCDDX, SRCDDY, SRCDDZ 

SR1DDX, SR1DDY, SRIDDZ^ 

SR2DDX, SR2DDY, SR2DDZ 
SR3DDX, SR3DDY, SR3DDZ ( 

SR4DDX, SR4DDY, SR4DDZ 

s 

*A1, A2, A3, A4 

*ADOTl, ADOT2, ADOT3, ADOT4 
*ADDOTl, ADDOT2, ADDOT3, ADDOT4 
Ml, M2, M3, M4 
CJ1, CJ2, CJ3, CJ4 
MASSD 
MASSC 
MT 


Time (sec) 

<p, 6, and \p 

w d 

^d 

{■*} 

{ r c> 



(0 

0d) 

0c} 



Od) 

{ f c} 


r r.\ 
V]/ 


0L \ 


0L\ 


0i\ 


m j 

c i 

m d 

m c 

m-p 
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TABLE IV.- PROGRAM SYMBOL LISTING - Continued 


[[An asterisk denotes printed output] 

FORTRAN notation Symbol definition 


Dll, D12, etc. 

[d] 

D011, T>Qfl2, etc. 

[ D lj 

DD11, DD12, etc. 

[6] 

Dill, DI12, etc. 

[D]- 1 

D0D11, DQfD12, etc. 

M 

D0DD11, D0DD12, etc. 

PO 

DQfDPDll, D0DPD12, etc. 

d(f) 

D0DTD11, D0DTD12, etc. 

8 l?i] 

ae 

DQfDSDll, D0DSD12, etc. 

# 1 ] 

d\[s 


XPR, YPR, ZPR 

x', y', and z' 

XPRD, YPRD, ZPRD 

x', y', and z' 

XPRDD, YPRDD, ZPRDD 

x% y\ z’, and {%} 

A1X, A1Y, A1Z 

(Al) 

A1DX, A1DY, A1DZ 

{Al> 

A1DDX, A1DDY, A1DDZ 

(Al) 

TXDK, TYDK, TZDK 

( T d> 

FXDK, FYDK, FZDK 

<Jd} 


RDD1X, RDD1Y, RDD1Z 
RDD2X, RDD2Y, RDD2Z 
RDD3X, RDD3Y, RDD3Z 
RDD4X, RDD4Y, RDD4Z 

ARDDX(l), ARDDY(l), ARDDZ(l) {Rd} 

ARDDX(3), ARDDY(3), ARDDZ(3) {r c } 
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TABLE IV.- PROGRAM SYMBOL LISTING - Concluded 
[An asterisk denotes printed output] 


FORTRAN notation 

TXX(l), TYY(l), TZZ(l) 

TXX(3), TYY(3), TZZ(3) 

TXX(4), TYY (4) , TZZ(4) > 
TXX(5), TYY (5) , TZZ(5) l 
TXX(6), TYY (6) , TZZ(6) [ 
TXX(7), TYY(7), TZZ(7)^ 

ID XX, IDYY, etc. 

IDDXX, IDDYY, etc. 

PHDEG, THDEG 
EL 

DISTZ 

KX, KY, KZ 

KRX, KRY, KRZ 

CX, CY, CZ 
CRX, CRY, CRZ 
II, 12, 13, 14 

IIX, I2X, I3X, I4X 

IIY, I2Y, 13 Y, I4Y 

*ETA 

*ETAX 

*ETAY 

*CM0 
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Cruciform rotor 


O' 

c 
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Spin 

Figure 1.- Dual-spin spacecraft equipped with passive balancing. 










Figure 3.- Schematic showing hub and disk connected through springs, dampers, 
and a bearing. Note that y,z -plane is similar to x,z -plane shown. 
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Figure 4.- Vector relationship of jth controller, overall mass center, and 

disk coordinate axes. 




of controllers 2 and 4 


Spacecraft mass center for controllers balanced about z axis 
and crew undeployed Uqz = r qxy = 0 ) 

mj2~ Spacecraft mass center with crew unbalance counteracted by 
controllers 



Figure 5.- Mass center geometry of controller steady-state response to 
combined static and dynamic crew unbalance. 
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mm 
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Figure 7.- History of overall mass center offset for crew disturbance simulations with 

and without passive controllers. 
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0 100 200 300 400 500 600 700 800 

Time, sec 

Figure 8.- Simulation history of principal-axis misalinement with and without passive controllers. 






System time constant, sec System time constant, sec 



Controller length, m 



Mass of each controller, kg 

Figure 10.- Effect of controller mass and length on system time constant. 
See table I for system constants. 
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4000 8000 12000 

Controller damping coefficient, Cj 


16000 


Figure 11.- Effect of controller damping on system time constant. 






96 


Figure 12.- Orientation of coordinate axes. 
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rotations < £j, 0j, and if/ j. controller degree of freedom 
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